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ABSTRACT 


A  Montecarlo  simulation  is  conducted  to  ascertain 
performance  of  the  ATIGS  system  in  a  proposed 
air-launched  cruise  missile  configuration.  Tne 
simulation  is  conducted  within  a  local-level  inertial 
frame  consisting  of  down-range,  cross-range  and  up  as 
primary  reference  vectors.  Efforts  are  made  to 
measure  the  relative  effects  associated  with  the 
intended  pure  position  reset  provided  by  a  micrad 
sensor  as  compared  with  those  effects  which  could  be 
expected  from  a  linear  suboptimal  Kalman  filtering 
scheme  used  in  conjunction  with  the  MICRAD  sensor 
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I.   INTRODUCTION 


The  purpose  of  the  Advanced  Tactical  Inertial  Guidance 
System  (ATIGS)  program  is  to  demonstrate  the  feasibility  of  a 
low  cost  inertial  system  to  be  used  in  the  Air  Launched  Low 
Volume  Ramjet  (ALVRJ)  cruise  missile  for  mid  course 
guidance.  Within  the  framework  of  this  stated  purpose  lies 
the  intent  to  furnish  moderate  accuracy  in  a  strapdown 
inertial  navigator  with  high  reliability  of  operation. 

The  strapdown  inertial  system  requires  a  computer  to 
provide  inertial  reference  ,  hence  the  possibility  of 
extending  the  computers  capability  by  installation  of 
Kalman  filtering  algorithms  is  seen  as  an  area  for 
investigation.  Previous  work  (ref.  1,2)  in  this  field 
indicates  that  the  computational  burden  associated  with  the 
Kalman  filter  limits  its  usefulness  when  position  updating 
systems  in  the  missile  give  highly  accurate  measurements  of 
actual  position.  Most  of  the  aforementioned  computational 
burden  resulted  from  the  on-line  gain  generation  required  by 
a  non-linear  model  within  the  Kalman  filter.  Hence  if  a 
linear  model  with  sufficient  performance  were  to  be 
incorporated  and  the  Kalman  gains  generated  off-line  and 
stored,  then  possibly  the  velocity  estimation  errors  which 
are  largely  unaffected  by  the  position  updates  could  be 
reduced. 

The  purpose  of  this  study  was  then  threefold 

1)  Test  a  linear  model  of  missile  dynamics  for  use  as   a 
simulation  tool. 


2)  Determine  the  inertial  navigator  accuracy  within  the 
six  degree  of  freedom  simulation  when  a  pure  position  reset 
device  is  installed  which  provides  position  updates  at  two 
points  along  the  flight  path. 

3)  Determine  improvements  in  missile  performance  if  a 
Kalman  filtering  scheme  were  installed  to  estimate  missile 
states  between  position  updates. 

The  means  by  which  accomplishment  of  the  desired 
purposes  was  obtained  were  various  Montecarlo  simulations 
utilizing  existing  data  on  the  proposed  inertial  guidance 
system.  Extensive  work, both  in  testing  of  physical 
eguipment  and  in  simulation,  had  previously  been 
accomplished  by  various  departments  of  the  Naval  Weapons 
Center,  China  Lake, Calif ornia.  Hence  accurate  data  as  to 
component  performance  were  available.  These  data  were 
utilized  to  construct  models  of  the  components  for  computer 
simulation. 

The  simulation  of  a  strapdown  inertial  guidance  system 
requires  the  nonlinear  computations  relating  observed 
accelerations  to  inertial  frame  coordinates.  This  is 
normally  accomplished  within  the  guidance-navigator 
algorithm  by  a  suitably  chosen  set  of  state  variables  and 
their  related  non-linear  dynamics.  The  essential  idea 
behind  the  linearization  technique  used  in  this  report  is 
that  the  non-linear  calculations  relating  accelerations  and 
angular  rates  to  velocity  changes  within  the  inertial  frame 
could  be  accomplished  upon  observation  of  the  said 
accelerations  and  rates  and  utilized  as  forcing  functions 
for  a  linear  model  of  system  dynamics.  This  corresponds  to 
a  free  inertial  system  with  observations  physically  aligned 
in  the  inertial  frame  of  reference.  Thus  velocity  changes 
in  the  inertial  frame  of  the  strapdown  guidance  system  would 
be  the  non-linear  combination   of   accelerations, angles  and 


angle  rates  which  are  treated  as  inputs 

The  model  dynamics  then  are  simple  linear  equations  for 
which  Kalman  filtering  gains  can  be  calculated  and  stored. 

The  proof  of  the  above  linearization  technique  would  be 
in  comparison  of  the  existing  empirical  performance  of  the 
ATIGS  system  with  the  observed  corresponding  simulation  of 
the  system  without  Kalman  filtering  installed.  Ref . (3) 
provides  ample  data  of  the  drift  of  the  ATIGS  system  as  a 
function  of  time  under  actual  flight  conditions.  The  data 
are  for  a  pod  mounted  version  of  ATIGS  installed  on  an  A-7 
aircraft.  Information  from  this  report  indicated  that 
ground  test  drift  of  the  system  was  on  the  order  of  1 
nautical  mile  (nm  )  per  hour  under  controlled  temperature 
conditions.  Dnder  free  flight  test  conditions  without 
temperature  control,  performance  was  degraded  to  4  nm  per 
hour.  The  temperature  instability  was  not  incorporated  into 
the  simulation  due  to  current  effort  to  provide  corrective 
measures  within  ATIGS.  Hence  verification  of  the  model  was 
assumed  if  simulation  indicated  drifts  of  1  to  2  nm  per 
hour. 

Once  verification  of  inertial-physical  model  was 
assumed,  the  next  phase  of  observation  of  effect  of  pure 
position  update  was  commenced.  Ref. 2  in  an  unclassified 
portion,  contends  that  the  optimal  weighting  of  filtered 
position  estimates  and  highly  accurate  measurement  of 
position  is  such  that  the  filtered  estimates  are  ignored. 
This  being  the  case,  the  computational  burden  imposed  by  a 
time  varying  Kalman  filter  may  be  unwarranted.  The  implicit 
assumption  here  is  that  the  velocity  errors  incurred  in  an 
unfiltered  system  are  not  significantly  decreased  by  the 
filter.  Therefore  the  position  reset  feature  would  be 
sufficient  to  provide  required  accuracy  at  mid-course 
termination.    This   conclusion   was  tested  by  simulation  of 


missile  flight  under  conditions  of  increased  noise  levels 
within  the  ATIGS  system  and  comparison  with  "normal" 
performance  obtained, which  allowed  visualization  of  the 
magnitude  of  end  point  error  incurred  under  conditions  of 
pure  position  reset  and  different  noise  level  sensors. 

The  final  phase  of  study  was  the  filtering  of  the  sensor 
outputs  to  provide  more  accurate  estimates  of  velocity 
throughout  the  flight.  No  attempt  was  made  to  filter  the 
position  update  measurements  due  to  their  reported  accuracy 
(sigma=50  ft) .  Thus  any  gains  in  performance  would  have  to 
be  from  the  filtered  estimates  of  position  after  position 
update  and  continuous  filtered  estimates  of  velocity.  The 
primary  indicator  of  accuracy  in  line  with  ref.2  was  taken 
to  be  cross  range  error  and  cross  range  error  covariance  as 
a  function  of  time. 
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II.   BASIC  DESCRIPTION  OF  THE  ATIGS  EQUIPMENT.  UTILIZATION 


The  approach  selected  for  i uplementation  of  ATIGS  within 
an  actual  cruise  missile,  was  to  employ  a  high-speed 
processor  to  handle  transformation  updating,  earth  rate 
torquing  and  other  minor  tasks  in  order  to  save  on  time 
requirements  on  the  more  complex  navigation  and  guidance 
computer.  This  peripheral  processor  would  then  supply  the 
central  processing  unit (CPU)  with  the  necessary  information 
that  it  required  to  compute  position  within  the  inertial 
guidance  frame. 

Thus  the  basic  ATIGS  unit  involves  ring  laser  gyros  and 
accelerometers  providing  information  to  the  peripheral 
processor  wherein  after  suitable  transformation,  inertially 
referenced  changes  in  state  variables  are  supplied  to  the 
main  navigation-guidance  computer.  The  main  computer  (CPU) 
then  has  an  auxiliary  input  from  an  external  position 
measuring  device,  the  Microwave  Area  Correlation 
fixer  (MICRAD) .  The  MICRAD  system  is  designed  to  provide 
highly  accurate  position  measurements  at  two  or  three 
preselected  checkpoints  along  the  route  of  flight.  These 
position  updates  would  then  be  utilized  within  the  CPU  to 
reset  the  inertial  guidance  estimate  of  position. 

At  present  the  only  filtering  system  installed  is  an 
application  to  the  initial  alignment  scheme  wherein  a  two 
stage  initialization  process  is  used  to  align  the  missile 
inertial  frame  with  the  parent  aircraft  inertial  frame. 
Filtering  is  not  used  presently  during  midcourse  guidance 
due  to  the  position  checkpoint  feature  and  the  short  time  of 
flight. 


11 


A   block   diagram  indicating  proposed  ATIGS  utilization 
within  the  ALVRJ  is  shown  in  £ig.1. 
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III.   INERTIAL  SYSTEM  SIMULATION 


A.   SYSTEM  CONSIDERATIONS 


The  inertial  navigation  system  incorporated  in  ATIGS 
consists  of  the  Honeywell  GG-1300  Ring  Laser  gyro  (RLG)  and 
the  Sunstrand  Q-flex  accelerometer  acting  as  sensors. 
Empirical  performance  data  for  these  sensors  are  found  in 
table  (1).  Both  sensors  are  considered  to  be  of  the 
integrating  type  in  that  the  output  of  the  RLG  is  in  the 
form  of  total  angle  change  per  pulse  and  the  output  of  the 
accelerometers  are  total  velocity  change  per  pulse.  The 
measurement  is  accomplished  within  the  RLG  by  means  of  a 
counter  system  which  totals  the  number  of  fringe  pattern 
passages  during  each  pulse  period  and  similarly  within  tne 
accelerometers,  the  total  velocity  change  is  proportional  to 
the  magnitude  of  the  output  pulse. 

In  view  of  the  above  characteristics  it  was  felt  that 
the  inertial  system  as  diagrammed  in  fig. 4  could  be  modeled 
simply  and  linearly  by  using  the  outputs  of  the  sensors  as 
forcing  functions  vice  part  of  the  state  vectors.  The 
similarity  between  fig. 1  and  fig. 4  should  be  noted.  This 
would  result  in  a  net  reduction  in  number  of  state  variables 
by  allowing  the  missile  dynamics  to  consist  of  second  order 
equations  of  displacement  and  first  order  equations  for 
angular  motion. 


B.   INERTIAL  FRAME  OF  REFERENCE 
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1 •   AL VE J  Implementation 

The  proposed  ATIGS  application  to  the  ALVRJ  utilises 
a  local-level  co-ordinate  frame  for  navigation  to  the 
target.  The  local-level  frame  is  characterized  by 
North, East  and  up  as  the  respective  axis  of  calculations. 
The  non-spherical  nature  of  the  earth  introduces  an  angle 
calculation  which  relates  the  local  gravity  vector  to  the 
position  vector  of  the  origin  from  the  earth's  center.  In 
the  ATIGS  unit,  the  gravity  vector  calculation  is 
accomplished  by  an  inverse  square  gravitation  model 


G  =  -(  KM/R3)  R  (1) 


where 

G  gravity  vector 

K  earth's  gravitation  constant 

M  mass  of  the  earth 

R  position  vector  from  earth  center  to  vehicle 

which   approximates   the  local  gravity  vector  to  the  desired 
degree  of  accuracy. 

The  vector  output  of  an  orthogonal  set  of 
accelerometers  is  the  geometric  sum  of  all  forces  which  act 
upon  the  vehicle  and  of  course  gravity  is  included.  Since 
the  above  calculation  is  dependent  on  position,  then  the 
gravity  vector  is  not  constant  during  the  time  of  flight. 
Thus  to  distinguish  between  the  effect  of  external  forces 
applied   to  the  missile  and  the  change  in  the  gravity  vector 

an  equation  such  as         i  ..  (2) 

Fa=Ca  VG 
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Fa       force  exerted  on  instruments 


Ca        coordinate   transformation   relating   inertial 
axis  (i)  to  accelerometer  axis  (a) 

R£       inertially  referenced  acceleration 

G        gravity  vector 

resolves  the  time  varying  accelerometer  outputs. 

ATIGS  accomplishes  the  above  procedure  within  the 
missile  and  calculates  the  proper  direction  and  range  for  a 
direct  steer  to  the  target. 

2 •   Sx§t em  Simulation 

The  simulation  of  the  ATIGS  mission  began  by 
approximating  the  local-level  inertial  frame  defined  in  1. 
above  as  a  dcwn-range,cross-range  and  up  frame  of  reference. 
Due  to  the  limited  range  of  the  missile  the  gravity  vector 
was  considered  constant  and  known,  hence  the  simulation 
simplified  to  a  simple  cartesian  co-ordinate  space  wherein 
the  navigator  assumes  knowledge  of  initial  position,  target 
position  and  range  to  target.  The  correct  heading  to  the 
target  was  assumed  to  be  the  positive  x-direction  with  the 
right-hand  system  defining  positive  cross-range  accordingly. 

The  initial  position  of  the  inertial  frame  of 
reference  was  taken  to  be  the  origin  and  instantaneous 
headings  were  taken  to  be  the  difference  between  the 
longitudenal  body  axis  and  the  positive  x  direction. 

The  ALVRJ  maintains  a  constant  wings  level  flight 
and  this  restriction  was  also  placed  upon  the  simulation. 
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Figure  2  -   SIMULATION  FRAME  OF  REFERENCE 
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C.   GENERAL  DEVELOPMENT 


Defining  a  set  of  state  variables  for  an  inertial  system 
undergoing  arbitrary  two  dimensional  translation  and  making 
the  careful  restriction  that  small  angles  and  very  small 
angular  rates  are  involved,  one  obtains  (neglecting  all 
noise  inputs) 

x  Distance  from  origin  down-range 

X  Velocity  in  down-range  direction 

Y  Distance  from  track  centerline 

Y  Velocity  component  vertical  to  centerline 

Theta      Angular  displacement  of  body  longitudinal  axis  to 
centerline 

Due  to  the  small  angles  and  negligible  effect  of  angular 

rates  one  can  approximate  the  accelerome ter  outputs  as 

Z-j_  =  accel.  in  longitudenal  body 

axis  =  Alb=  AV^b  (3) 

Z2=accel.  in  lateral  "body  axis= 

A2b=  A  V2* 

where   the   E   subscript  indicates  body  axis.   Tne  output  of 
the  single  gyro  is 


Now 


AX=AVlbcos   91-  AV2bsin  Q±   +  V^Acos   Q± 
-V^sin  91 

A  Y=  AVlbsin  01+  AV2bcos   01    +  V^A  sin  91 
+V2bAcos  e1 
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(5) 


(6) 


Where 


AX=Z1cos   e.-ZpSin  9.-+V*^A  cos   S^-V^A  sin  61 
A  t=ZjSin.  ©^   +Z2cos   e1+Vlb^  sin  Q1   +V2bAcos  0. 


Which   can   be    further   approximated   by 
Afel-Z29fVl49fT2ba9l 

=zi-z29rv2bz3  (7) 

A^z101+z2+v1^s1-v2te1Ae1 

=zlVZ2+VlbZ3 


Further    utilization    of    small   angle   approximation   yields 


Vlb=X 


V      =   Y 

2b      x 


Hence 


(8) 


AX  =   Z      -   Z0  -    Y  ZQ 

A  Y  =   Z1©1  +    Z2  +  X   Z3  (8a) 

and   for    unit  time    intervals    the   discrete   state   equations   are 

X(k+1)=  X(k)  +  X(k)    +   ,5*AX(k) 

X(k+1)=  X(k)  +  AX(k) 

Y(k+1)=  Y(k)  +  Y(k)    +   .5*AY(k)         (9) 

Y(k+1)=   Y(k)  +AY(k) 

6|k+l)=  ^(k)  +A91(k) 
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Thus  the  observations  can  be  treated  as  inputs  to  the 
system  after  appropriate  substitution.  The  above  model  can 
be  expanded  to  three  dimensions  and  six  degrees  of  freedom 
by  the  addition  of  one  cartesian  and  two  angular  coordinates 
which  would  then  consist  of 


Z(k),Z(k),  e2,  &3 
for  a  total  of  9  states. 

This  development  was  accomplished  without  noise 
considerations.  In  the  physical  system  noise  would  exist  in 
the  form  of  measurement  noise  in  both  the  accelerometers  and 
the  gyros.   Hence 

z2=AV2b  +  £  (10) 

z3=Ae1  +  tpt 

and 


Cx  =  z1  -  z2e1   -  yz3-  yf  -5je1-Yj^ 

AY  =   Z181  +Z2+  XZ    -    ^91+^_+X^> 


(11) 


The  purpose  of  this  approach  was  to  utilize  the  outputs 
of  the  sensors  as  forcing  functions  for  the  linear  model. 
Hence  in  the  preprocessor  the  non-linear  calculations 
involving  observations  and  states  can  easily  be  accomplished 
such  that  one  then  obtains 

\=\-   Z29l  "  *Z3 

U2  =  Z191  +  Z2  +  *Z3  (12) 

U3  =  Z3 
as    hypothetical    and    known    forcing   functions.    Thus 
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substitution   into    the      model      of      the      system      of       0  £*0     forAXGO 

»  .  * 

and     14 Cx)    for     d<y  00   would    result  in 

X(k+1)    =  X(k)    +  X(k)    +   ,5*(AX(k)+^ 

+  ^ie1  +  Y(k)V?  ) 
X(k+i)  =  x(k)  +  Ax(k)  +  A   +  x^e^k) 

+  Y(k)#  (13) 

Y(k+1)    =  Y(k)    +  Y(k)    +   .5*(AY(k)+     2^  e^k) 

+    £  +X(k)<#      ) 
Y(k+1)    =  Y(k)    +  A  Y(k)    +     ^  B1(k)    +  ^ 

+  x(k)v? 
e1(k+i)=  e1(k)  +  A  e1(k)  +<fi 

Hence  the  net  result  is  the  addition  of  a  process  noise 
term  to  the  model.  Analysis  of  this  noise  term  proceeds 
with  the  systematic  elimination  of  the  non-linear  term 
involving  tf~  and  ©  .  This  is  easily  justified  due  to 
the  small  value  of  **"  and  O  .  Thus  one  is  left  with 
down-range    process   noise   involving    o',  and  V  &       and 

cross-range  noise  terms  involving  ^  and  X^>  .  Clearly 
the  non-linear  terms  will  dominate.  The  conclusion  that 
logically  follows  is  that  the  linearization  technique 
utilized  above  will  obviously  be  accurate  for  small  angles 
in  a  manner  proportional  to  the  magnitudes  of  the  quantities 
yff  and  Xtf  .  Furthermore  it  indicates  that  Kalman 
filtering  will  be  most  effective  in  the  estimation  of  angle 
information  and  of  much  smaller  benefit  in  the  filtering  of 
accelerometer  noise. 
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PARAMETER 


UNIT 


PERFORMANCE 


UNITS 


RANDOM  WALK  (   /hr) 


GG-1300-RLG 


BIAS    STABILITY    (   /hr.  ) 


SAME 


BIAS    SENSITIVITY 

<>. 
f) 


SCALE   FACTOR         (%) 


SAME 


BIAS   UNCERTAINTY 

(ug) 


SCALE    FACTOR    (ug/g) 


SAME 


Q-FLEX 


SAME 


.0075 


.009 


00037 


.016 


79.0 


63 


1  lhr. 


TABLE     1-PUBLISHED    UNCERTAINTIES    OF    THE    ATIGS 
COMPONENTS 
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Thus  the  total  state  vector  would  consist  of  9  states  as 
opposed  to  the  15  state  vector  considered  essential  in 
reference  2.  The  above  technique  was  inspired  by  Kortum  in 
his  development  (ref.  6)  on  Kalman  filter  applications.  The 
inertial  computation  scheme  is  based  on  several  assumptions, 
all  of  which  are  results  of  the  short  time  of  flight-short 
range  requirements  of  the  ALVRJ  application.  These 
assumptions  are 

1.  Constant  gravity  vector  over  a  40  nm.  flight  path 

2.  Earth  torguing  not  required 

3.  Small   angle  assumptions  for  largest  portions  of 
flight 

D.   BASIC  SIMULATION  DESIGN 


1 .   Gene r al  Considerations 

In  order  to  verify  that  the  nine  state  system  would 
be  adequate  for  modeling  purposes,  a  simulation  program  to 
test  performance  was  conceived.  The  actual  missile  flight 
profile  includes  accelerations  after  launch 
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G'S 


20     TIME 
(SEC) 


Figure    5    -      ACCELERATION    PROFILE 
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up  to  a  maximum  of  16  g' s (fig. 5) from  the  initial  conditions 
given  in  fig. 6.  In  addition,  it  is  to  be  noted  that  for 
simplicity  a  homing  type  guidance  command  is  given  to  the 
missile  dynamics.  This  is  recognised  as  ineffecient  in 
practice  but  is  simple  in  i  irplementation  and  provides  a 
basis  for  comparison  purposes.  Since  missile  flight 
controls  respond  to  airspeed  and  not  inertial  speed,  the 
velocities  used  in  the  missile  dynamics  portion  of  the 
algorithm  ate  true  airspeeds.  However  the  inertial  system 
must  always  compute  in  inertial  velocities  and  hence  must 
either  adjust  its  calculations  to  include  this  difference  or 
accept  any  error  that  this  difference  may  entail.  It  is  to 
be  noted  that  no  means  of  velocity  measurement  (i. e. 
doppler,mach  gauge, etc.)  is  to  be  provided.  In  this 
simulation  the  difference  is  ignored  due  to  the  large 
magnitude  of  inertial  velocities  obtained  and  the  short  time 
of  flight. 

2 •   Noise  Input  Design 

The  randcm  number  generators  used  in  this  simulation 
were  of  two  types;  Gaussian  and  uniform.  The  Gaussian 
generators  provided  the  noise  inputs  to  the  various  sensors 
and  the  uniform  generators  provided  the  initial  conditions 
and  wind  effects.  The  wind  effects  were  such  that  constant 
bias  directions  of  positive  cross  range  and  negative 
down-range  conditions  were  imposed.  The  mean  value  of  wind 
components  in  each  direction  was  30  ft  per  sec.  with  a 
range  of  +  /-8  ft  per  sec.  maximum  change  per  second.  No 
attempt  was  made  to  ascertain  the  relevance  of  the  chosen 
wind  model, its  purpose  was  purely  to  introduce  a  bias  into 
the  system  equations  in  order  that  the  scale  factor  noise 
term  of  the  gyros  could  be  exercised.  The  scale  factor  term 
was  finally  dropped  from  the  model  of  the  gyros  but  the  wind 
bias  was  retained. 
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The  Gaussian  generators  provided  noise  inputs  to 
each  of  the  six  installed  sensors.  The  chosen  model  of  the 
accelerometer  noise  term  was 

*\,2,3=E0G1.2,3+WG1,2,3*A1,2,3         W 
where 

EOG  random  bias  term  held  constant  over  the  entire 
flight  but  varied  prior  to  each  sample  in  the  montecarlo 

WG-scale  factor  term  which  varies  through  the  flight 

The  chosen  model  for  the  gyro  noise  term  was  more 
complex  consisting  of  bias  terms  and  a  random  walk  term.  A 
random  walk  generatior  is  described  in  general  terms  as 

E   =  u  (15) 

r    r 

where  Er  is  the  error  at  a  given  instant  and  Ur  is  a 
white  noise  term  with  a  standard  deviation  of  G^  .  The 
variance  of  E^.  grows  linearly  with  time  according  to  the 
relation 

0*1  =t0"5  (16) 

with  @e  given  empirically  in  table  1  as  random  walk  in 
/'hr  with  an  uncertainty  of  lcrihr  =.0075  .  For  a  sample 
generator  to  be  used  every  second 

Q-   =  01  /  60  (17) 

ur     V 


An   error   from   each   gyro   is   introduced  into  the 
inertial  computation  which  is  treated  as  a  change  in  & 

<P   (t)  =  E0  +  G(t)  (18) 

PHI      error  of  each  gyro  per  interval  of  time 
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EO       constant  bias  term  per  flight 
G        result  of  random  walk 

3.   Changes  in  Heading  fiesulting  in  Velocity  Changes 

The  computation  of  velocity  in  the  inertial  frame 
consists  of  terms  which  relate  the  change  in  heading  to 
changes  in  inertial  velocities.  For  small  angular  rates  the 
changes  in  velocity  in  the  inertial  frames  show  as  inputs 
i.e.  A»XX,AMXY,  AWYY,AWYZ,AWZZ, AWZX. 

AWXY  is  the  change  in  velocity  in  the   X (down- range) 
direction   due  to   a  change   in  direction  6u   .   This  is 
expressed  in  small  angle  approximations  as 


AWX 
AWY 

AWZ 


1 

AS, 

-A9 


y 


-  A0, 

1 

-  A9 


x 


A0 
AG. 


y 


X 


X 
I 

z 


(19) 


AWX  is  the  total  change  in  velocity  in  the  x  direction  due 
to  small  angle  change.  This  calculation  is  performed  in  the 
appropriate  missile  dynamics  portion  of  the  simulation  where 
the  A©*  ar€  the  results  of  commands  from  the  guidance 
system  of  the  inertial  system.  In  the  inertial  system  these 
quantities  are  treated  as  A©^-s  or  measured  changes  and  all 
velocity  changes  are  computed  based  on  gyro  outputs. 

** •   Guidfl£ce  System  Design 
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The  specific  algorithm  for  generation  of  guidance 
commands  was  simple  due  to  the  homing  type  control  employed. 
Inherent  in  the  cross-range, down-range  reference  frame  is 
the  knowledge  of  distance  remaining  or  "time-to-go"  for 
termination  cf  midcourse  guidance  and  initiation  of  terminal 
guidance  procedures.  A  parameter  that  continues  to  be 
significant  within  this  project  is  the  small  angle,  small 
rate  assumption.  In  the  guidance  algorithm  the  one  second 
time  intervals  chosen  for  use  would  require  an  inordinately 
long  sequencing  operation  if  commands  were  given  in  terms  of 
rates.  To  clarify  this  statement,  rate  systems  require  an 
initiation  and  termination  command,  which  for  one  second 
intervals  would  require  a  two  second  execution  time. 
Therefore  the  guidance  system  employed  within  this  project 
determines  total  angle  change  necessary  and  then  commands  an 
automatic  pilot  to  accomplish  this  change.  Thus  the  forcing 
function  to  the  inertial  navigator  equations  is  not  an  input 
to  the  rate  variables  but  rather  to  the  angular  displacement 
variables.  No  process  noise  was  assumed  for  small  angles 
hence  the  actual  angle  change  was  set  equal  to  the  commanded 
angle  change.  Notice  that  this  is  basically  an  open-loop 
process  wherein  the  inertial  navigator  does  not  predict  the 
next  state  based  on  the  commanded  heading  change  but  rather 
on  the  noisy  observed  heading  change. 

The  logical  question  then  arises  as  to  the  effect  of 
system  drift  during  guidance.  Normal  procedure  would  be  for 
a  heading  change  command  system  in  which  an  error  signal 
generated  by  the  navigator  would  be  driven  to  null  by  the 
rotation  of  the  vehicle.  System  drift  during  the  heading 
change  operation  would  result  in  process  noise  inputs  to  the 
navigator  equations.  The  above  was  felt  to  be  undesireable 
due  to  Kalman  filter  operation  characteristics  wherein 
steady  state  gains  are  non-zero  for  a  linear  system  under 
process  noise.  The  method  of  circumventing  this  discrepancy 
was   to   use   as   the   forcing  function  the  observed  heading 


29 


change  for  the  update  of  the  navigator.  Thus  in  the  absence 
of  process  noise  an  accurate  indicator  of  measurement  noise 
would  be  the  difference  between  observed  heading  change  and 
commanded  heading  change.  This  concept  was  to  be  used 
during  the  Kalman  filter  application. 


The  algorithm  for  command  guidance  is  given  in 
fig. 5.  The  "time- to-go"  concept  allows  for  a  continual 
estimate  of  distance  remaining,  and  a  simple  heading 
calculation  computes  the  heading  change  necessary  for 
homing. 


e 


m 


uired" 


cross-range  position 


final  position  -  present  position  /on\ 
Y(k)  uu; 

240000-X(k) 


It 

simulation 


should  be  noted  that  the  flight  profile 
was  terminated  at  a  point  where  the  inertially 
computed  down-range  position  was  greated  than/or  equal  to 
the  final  position.  This  would  correspond  to  the  switchover 
point  for  terminal  guidance. 
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GUIDANCE  COMMANDS  ALGORITHM 
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STATE  VARIABLE 

1 

COORDINATE 

MEAN 

STD 

.    DEVIATION 

downrange 

0.0  ft 
(0.0  m) 

1 

=  387.0  ft 
(118  m) 

POSITION 

crossrange 

0.0   ft 
(0.0  m) 

1 

=  387.0  ft 
(118  m) 

altitude 

35000   ft 
(10668  m) 

1 

=   0.0   ft 
(0.0  m) 

downrange 

670   ft/sec 
(204.2  m/sec) 

1 

=6.0  ft/s« 
(1.83  m/i 

VELOCITY 

crossrange 

670   ft/sec 
(204.2  m/sec) 

1 

=6.0  ft/s 
(1.83  m/j 

vertical 

0.0   ft  /sec 

1 

=0.0  ft/s 

i 

(0.0  m/sec) 

(0.0  m/3 

°i 

0.0° 

1 

=   2  min 

ALIGNMENT 

°2 

0.0° 

1 

=   2   min 

o„ 

0.0° 

1 

=   2  min 

1 

3 

Figure  7  -   INITIAL  CONDITIONS  AT  LAUNCH 
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ALGORITHM    FOR    MODEL    OF    MISSILE    DYNAMICS    WITH 
PURE    INERTIAL    COMPUTATIONS 
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5-   Position  Update  System 

The  position  update  system  (MICRAD)  is  designed  to 
fix  the  missile  position  at  various  check  points  along  the 
flight.  Currently  it  is  intended  for  the  missile  to 
navigate  to  each  checkpoint  inertially  and  upon  arrival  fix 
its  position.  The  missile  would  then  compute  the  course  to 
the  next  check  point  and  proceed  to  navigate  to  that   point. 

For  purposes  of  this  simulation  and  in  order  to 
reduce  complexity  and  computer  time  requirements,  the 
missile  estimated  position  was  set  equal  to  its  actual 
position  at  two  discrete  time  steps.  The  inertial 
navigation  system  was  thus  reset  at  time=15  sec  and  time=80 
sec. 

The  projected  accuracy  of  the  MICRAD  position 
measurement  system  is  <J-  50. 0  ft  at  low  altitudes.  Thus  a 
noise  term  was  added  to  the  measurement  of  position  within 
the  simulation  in  an  effort  to  retain  agreement  with 
empirical  data. 

The  magnitude  of  the  deviation  of  the  position  fix 
is  the  fundamental  argument  in  ref.2  for  the  elimination  of 
the  Kalman  filter  from  the  inertial  system.  The  rational 
behind  this  assertion  is  that  if  two  estimates  of  position 
are  available  (i.e.  Kalman  filter  position  estimate  and  a 
MICRAD  estimate)  then  the  weighting  placed  on  each  estimate 
would  be  heavily  in  favor  of  the  more  accurate 
estimate , logically  the  MICRAD  fix.  The  optimal  mix  of  the 
two  estimates  would  then  be 

X  =  M  X   +  (I-M)  X  (21) 

n  m 
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where 

X  =  navigation  estimate  =  X  +  p 
n       t» 

p  =  navigation  estimate  error 

X  =  measurement  estimate  =  X  +  r 
m 

r  =  measurement  error 
M  =  r  /  (r  +  p) 
thus 

X  =(r/(r+p))Xn  +   (p/(r+p))Xm    (22) 

since  logically 

r<  <  p 

X  =  X 
m 

and  the  Kalman  filter  estimates  are  ignored. 

From  the  above,  it  can  be  seen  that  filtering  for 
positon  is  required  only  in  the  intervals  between 
observations  and  that  the  optimal  mix  of  filtered  position 
and  observed  position  reduces  to  the  observed  position  for 
highly  accurate  measurements. 


6 .   Statistical  Formulations 

The  primary  measures  of  system  performance  for 
inertial  navigation  systems  are  mean  of  estimation  error 
(i.e.  the  mean  of  actual  position  minus  inertially 
calculated  position)  and  variance  of  estimation  error.  The 
mean  of  estimation  error  reflects  the  result  of  bias  within 
the  inertial  system  and  the  variance  of  estimation  error  is 
an  indicatioc  of  system  reliability.  The  simulation  program 
adopted  in  this  study  evaluated  the   mean   of   position  and 
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velocity  as  well  as  their  variance  at  each  one  second 
interval  along  the  flight  path  in  addition  to  the  estimation 
error  mean  and  variance.  The  final  position  states  were 
also  computed  and  the  mean  and  variance  presented 
seperately.  It  was  felt  that  this  information  could  give  a 
qualitative  comparison  of  the  missile  performance  with  and 
without  the  Kalman  filter  installed. 

The  mean  and  variance  equations  for  each  time 
interval  was  computed  using  standard  summation  and  averaging 
techniques.   Thus 

X  =  1/n  ^  -  (23) 


with  the  inherent  assumption  that  the  relative  frequency  of 
occurence  is  analagous  to  the  probability  of  occurence.  The 
variance  was  computed  similarly  with 


S2 


=  (l/(n-l))   Y.     (x.-X)2         (240 


36 


17.   KALHAN  FILTER 


A.   INTRODUCTORY  REMARKS 


Ref . 12  discusses  various  aspects  of  the  philosophy  of 
Kalman  filter  applications  in  a  very  concise  manner.  Within 
this  discussion  the  practical  limitations  of  implementation 
are  specified;  the  foremost  limitation  being  that  of  a 
prerequisite  knowledge  of  the  exact  statistical  description 
for  each  random  signal  within  the  system.  This  a  priori 
information  determines  the  degree  of  optimality  of  the 
filter. 

The  filter  is  said  to  be  optimum  in  the  sense  that  it 
generates  an  unbiased,  minimum  variance  estimate  of  the 
states  of  a  linear  system  from  some  noisy  measurement  of  a 
subset  of  those  states.  The  requirements  imposed  upon  the 
designer  are  :  exact  knowledge  of  the  system  dynamics, 
covariances  of  initial  conditions,  and  noise  inputs. 
Departure  from  optimality  arises  when  either  estimates  of 
the  above  quantities  are  used  or  approximations  to  the  state 
equations  with  lesser  state  variables  comprise  the  model  of 
system  dynamics. 

Previous  studies  indicate  that  best  results  are  obtained 
with  pessimistic  estimations  of  design  parameters  and 
linearization  of  non-linear  systems  if  possible.  The 
pessimistic  estimate  of  design  parameters  reduce  the 
sensitivity  cf  the  desiga  to  deviations  within  the  system 
while   linearization   results   in  off-line  gain  calculations 
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which  significantly  reduce  the  computational  requirements. 

The  linearization  technique  analysis  of  this  study 
indicates  that  the  model  of  the  system  error  terms  are  most 
critical  in  the  estimation  of  theta.  The  cross- range  and 
down-range  position  error  being  most  dependent  on  these 
terms.  Since  digital  filtering  computational  requirements 
increase  roughly  as  the  square  of  state  variables, 
effeciency  dictates  that  the  number  of  filtered  variables  be 
minimized.  Therefore  it  was  felt  that  the  best  usage  of 
Kalman  filter  techniques  would  be  in  the  estimation  of 
theta. 

This   evaluation  is  supported  by  various  references  (6, 8) 
most  notably  ref.6. 


B.   GENERAL  THEORY 

Given   a   plant   characterized   by   the   linear  discrete 
equations: 

X(k+1)=  0(k+l,k)X(k)  +  A(k+l,k)U(k)+  W(k) 

(25) 
£(k)  =   C(k)X(k)  +  V(k) 

where 

X(*0  Column   matrix  of  states 

0(fc+i,k')  state  transition  matrix  for  time  k  to  time  k  +  1 

A^'.K)  Forcing  transfer  function 

wM  Process  noise  term 

Z-M  Matrix  of  observations 

V(k)  Measurement  noise 
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With  the  appropriate  assumptions   concerning  zero   mean 
noise   terms   and   knowledge   of   the   covariance  of  initial 

conditions,  the  optimal  estimate  of   the   state  vectors   at 

time  k   can   he  arrived  at  through  suitable  use  of  a  Kalman 

filter.   This  estimate  will  be  characterized   by  a   minimum 

variance  of  estimation  error  as  its  criteria  for  optimality. 
The  Kalman  filter  equations  are: 

£(k)  =  P(k/k-l)/g(k)t  [c_(k)p(k/k-l)c(k)  +  R(k)3  "1 
P(k/k)  =  ri-G(k)C(k)3  P(k/k-l) 

P(k+l/k)  =  g  (k+l,k)p(k/k)  ^  (k+l,k)  +  (g(k)       (26) 
X(k/k)  =  X(k/k-l)  +  G(k)  [_Z_0O  -  C(k)X(k/k-lJ 
X(k+l/k)  = /0(k+l,k)X(k/k)  +  4(k+l,k)U(k) 

where   the  notation  (k.+  1/k)  implies  the  estimate  at  time  k+1 
given  time  k. 


C.   SPECIPIC  THEORY 


The  current  method  of  filtering  inertial  navigation 
systems  is  by  building  the  filter  specifically  around  a 
given  error  model  of  the  gyro.  The  most  commonly  used  error 
model  is  a  Gauss-Markov  drift  model  described  by  both 
correlated  n <ise  and  bias  terms. 


D  =  -  (1/Y  )D  +  r  (27) 

where  D  is  the  instantaneous  value   of   error,   Y    is   the 
correlation   time  and   i*  is  a  bias  term.   Statistically 

the  time  function  has  been  found  to  be  roughly  equivalent  to 

a  random  walk  model  such  that 

D  =  w  +  r  (28) 
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where  W  is  a  white  noise  term.  Since  the  above  drift  is 
colored  noise  it  has  been  handled  previously  by 
incorporating  it  in  the  state  matrix  such  that  it  is  part  of 
the  estimation  process.  The  state  equations  would  then 
become 

e2=  o  (29) 

D  =  w  +  r 

z  =  e2+  b 

Thus  the  Kalman  filter  would  be  designed  for  a  3  state 
vector  vice  the  needed  two  states.  Also  the  presence  of 
process  noise  requires  a  non  zero  steady  state  value  for  the 
gains  of  all  equations  in  the  update  portion  of  the  Kalman 
filter.  This  means  that  improper  choice  of  parameters  will 
bias  the  estimatior  for  all  time 

The  overriding  consideration  of  this  study  being  the 
desire  to  maintain  as  few  state  variables  as  possible 
prompted  a  closer  look  at  the  above  method  of  analysis. 

The  inertial  navigator  had  been  modeled  as  a  first  order 
system  earlier (sect. I) 

0I(k+l)  =  6I(k)  +  eM(k)  (30) 

however  the  Kalman  filter  requires  an  observation  matrix  and 
the  above  model  uses  the  observation  matrix  ^0)AOO  as  a 
forcing  function  therefore  for  filtering  purposes  the  rate 
variables  had  to  be  redefined  and  a  new  state  added. 


91  (k+l)=  01  (k)  +  ei  (k)  +  A©M 

9i2(k+i)=  ei2(k) 


(31) 


The  new  state  variable   ©lp    ^s  to  represent   a   small 
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angular  rate  which  should  be  zero  under  normal  conditions. 
Notice  that  the  forcing  function  is  solely  upon  the  angular 
position  and  not  upon  the  rate  variable.  Now  the 
observation  is  the  output  of  the  gyro  which  is 

49M(k)  =  A©(k)  +  9I2(k)*  A  t  +  ^?(k)*  A  t    (32) 

where    ip  is  the  noise  term  for  the  gyro  given  by 

{p   (k)  =  EO  +  G(k)  (33) 

SO  is  a  constant  bias  and  g (k)  is  a  white  noise   term.    The 
noise  equation  then  for  unit  time  intervals  are 

A^(k)/At  =  EO+G(k)  =A^(k)     (34) 

and   the    observation   equation    is 

AOM(k)  =  A.©(k)  +  9I0(k)  +  &<p 

(35) 
0(k)  +  9I2(k)   +  EO  +  G(k) 

Now  AO  is  a  known  forcing  function  generated  by  the 
inertial  navigator  therefore  a  new  observation  can  be 
defined  as 

Z^(k)  =  A9M(k)  -  A9(k) 

(36) 
=  ei2(k)  +  EO  +  G(k) 

thus  the  discrete  state  equations  are 

91  (k+1)  =  0I1(k)  +  9I2(k)  +  A9(k) 

91- (k+1)  =  91.  (k) 

1  (37) 

Z*(k)  =  0I2(k)  +  EO  +  G(k) 

Now  if  the  constant  bias  term  EO  is  added  to  the  ^I2(k)   and 


redefined  as 


9I2(k)  =  91  (k)  +  EO  (38) 
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Then  it  can  be  seen  that  the  ©I.(K)  term  takes  on  the 
significance  of  an  estimated  drift  and  the  state  equations 
then  assume  the  form 

ei  (k+i)  =  ei  (k)  +  ei^Ck)  +  Ae(k) 
ei2(k+i)  -  ei2(k)  (39) 

Z*(k)  =  0I2(k)  +  G(k) 

Where  g(k)  is  white  noise  and  the  state  equations  are  now  in 
standard  form  for  Kalman  filtering. 


It  was  necessary  to  add  one  more  state  per  gyro 
simulated  but  this  brings  the  total  state  vector  to  only  12 
which  is  still  a  net  savings  in  state  variables. 

A  block  diagram  of  the  algorithm  is  given  in  fig. 09. 


D.   KALMAN  FILTER  RESULTS 


The  general   Kalman   equations   of   part   B  above   were 

applied   to   the   angular   state   variables  in  an  off-line 

calculation  by  applying   pessimistic   estimates  of   initial 
condition  variance  such  that 

2  -03 

CT  «  ,„x=  1.00  x  10 


e1(o 


(40) 


V   02(O)=  u00°  x  10"°3 

and    the    variance   on    the    measurement   noise    to   be 


cr2(  <p  )  =  1.000  x  10"03 


The   resulting   gains   were   found   to   be  simple   time 
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functions   such   that   at   time    T=K  A   t 
Gx(k)  =     i-(2/k+l) 

G2(k)  =   l/k+1 


(41) 
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ALGORITHM  FOR  PROPOSED  KALMAN  FILTER 
IMPLEMENTATION 
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V.   ANALYSIS  OF  RESULTS 


A.   VERIFICATION  OF  RESULTS 


Due  to  the  high  degree  of  simplification  of  plant 
dynamics,  the  basic  plant  model  is  felt  to  be  weak.  The 
linear  dynamics  applied  to  the  given  g  profile  produced  a 
trajectory  similar  to  the  expected  flight  profile  of  the 
ALVRJ  but  (due  to  its  simplified  nature)  with  several 
defects.  The  descent  produced  a  net  increase  in  forward 
velocity  after  level  off  which  would  not  be  the  case  for  a 
true  non-linear  model.  This  defect  can  be  accommodated  by 
th€  inertial  system  and  hence  was  not  felt  to  be  detrimental 
to  the  purposes  of  this  study. 

Further  work  in  this  area  would  be  recommended  in  order 
that  basic  defects  in  the  missile  such  as  thrust 
mis-alignment,  process  noise  in  control  actuators  and  sensor 
misalignment  be  introduced  into  the  simulation  .  A  better 
tracking  scheme  could  easily  be  instituted  such  that  the 
guidance  algorithm  could  institute  a  more  efficient 
trajectory. 

It  was  felt  that  for  purposes  of  this  study  the  plant 
model  provided  a  reasonable  approach  to  ALVRJ  simulation. 
The  time  of  flight  and  velocity  profile  are  within  the  same 
general  order  of  magnitude  as  the  more  complex  simulations 
provided  by  ref. 1  and  correspond  with  physical  intuition  as 
to  proper  missile  performance. 
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B.   VERIFICATION  OF  ATIGS  SIMULATION 


It  was  felt  that  the  simulation  of  the  ATIGS  would  be 
accurate  for  purposes  of  this  study  if  the  error  growth  rate 
and  the  standard  deviation  growth  rate  incurred  by  the  model 
were  close  to  the  observed  quantities  set  forth  in  ref.1  and 
ref.3.  Reference  3  stated  that  observed  drift  in  the  ATIGS 
test  unit  was  approximately  1  nm  /hr  in  ground  test  and  4  nm 
/hr.  in  airborne  test.  The  simulation  results  show  a 
numerical  average  drift  of  3.35  nm  /hr.  which  was  felt  to 
be  in  the  range  of  the  actual  system.  Ref . 1  indicates  that 
the  simulation  reported  therein  had  a  cross-range  standard 
deviation  growth  rate  of  1400  ft./min.  between  the  first  and 
second  reset  positions.  The  simulation  within  this  study 
had  a  cross-range  standard  deviation  growth  rate  of  1459.4 
ft./min. 

From  the  above  correlation  in  performance  the  study 
proceeded  under  the  assumption  that  the  simulated  model  of 
the  ATIGS  would  provide  a  reasonable  background  for  analysis 
of  position  reset  and  Kalman  filter  performance  in  an  actual 
installation. 


C.   EFFECT  OF  POSITION  RESET  ON  SIMULATED  PERFORMANCE 


The  unfiltered  position  reset  feature  of  this  simulation 
had  the  expected  result  of  drastically  decreasing  the 
variance  at  mid-course  termination.  The  pure  inertial 
navigator  must  contend  with  both  initial  condition  errors 
and  integrated  boost  phase  errors  which  combine  to  produce 
large  scale  variance  at  mid-course  termination.  The  initial 
position  reset  occurs  after  boost  is  complete  and  thus 
virtually   eliminates  the  initial  condition  and  boost  effect 
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on  position.  However,  as  expected,  the  velocity  and  angular 
errors  of  boost  and  initial  condition  still  have  effects  on 
the  final  value  of  position  at  mid-course  termination.  The 
basic  ATIGS  navigator  without  position  reset  was  found  to 
have  a  radial  uncertainty  of  1608.6  ft.  at  mid-course 
termination  (see  table3) .  The  addition  of  position  reset  to 
the  basic  model  was  found  to  reduce  this  uncertainty  to 
466.9  ft.  However  these  figures  reflect  the  inherent 
accuracy  of  the  inertial  navigator  with  the  very  low  error 
terms  in  the  sensors.  If  the  noise  terms  in  the  inertial 
navigator  are  allowed  to  have  their  standard  deviations 
increased  by  a  factor  of  5,  thus  simulating  a  very  noisy 
inertial  navigator,  the  basic  ATIGS  model  without  position 
reset  demonstrates  an  uncertainty  of  8646.5  ft.,  and  after 
the  addition  of  position  reset, 4128.0  ft.  Thus  it  can  be 
seen  that, even  with  a  position  reset  very  close  to 
mid-course  termination,  large  uncertainty  of  position  can 
accumulate  due  to  the  magnitude  of  the  velocity  errors  which 
accrue  throughout  the  flight. 


D.   EFFECT  OF  ADDITION  OF  LINEAR  SUB-OPTIMAL  KALtfAN  FILTER 


The  Kalman  filter  proposed  in  this  report  had  the  effect 
of  decreasing  the  variance  of  simulation  behavior  along  the 
flight  path  for  all  tested  situations  (see  table  2)  .  If 
cross-range  standard  deviations  is  taken  as  the  criterion 
for  performance  quality,  it  can  be  seen  that  the  filtered 
performance  is  readily  superior  at  all  noise  levels.  The 
"normal"  noise  level  exhibits  a  radial  uncertainty  of  248.03 
ft.  at  mid-course  termination  and  the  X5  noise  level 
exhibits  a  radial  uncertainty  of  1083.1  ft.  The  fundamental 
reason  for  this  increase  in  accuracy  is  shown  in  table  4, 
where  the  velocity  errors  at  final  update  position  are 
compared.   The  filtered   velocity   estimates,   even   at   the 
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higher   noise   levels,   are  such  that  mid-course  termination 
position  is  within  much  more  reasonable  bounds. 

The  overall  effect  of  the  Kalman  filter  proposed  in  this 
study  then  is  to  reduce  the  end  point  variance  of  missile 
position  at  mid-course  termination  in  a  significant  manner. 
The  unfiltered  updates  of  position  are  seen  to  be  valuable 
when  used  in  conjunction  with  the  Kalman  filter  but  do  not 
insure  adequate  missile  performance  if  high  noise  levels  are 
encountered  throughout  the  flight. 
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type  run 

noise   level 

velocity  error 
std.    deviation 

ATIGS 

NORMAL 

110.4   ft/sec 

ATIGS 

X5 

562.47    ft/sec 

M®D& 

NORMAL 

104.65    ft/sec 

i»s 

X5 

642   ft/sec 

ATIGS.MICRAD 
&  KALMAN 

NORMAL 

62.8   ft/sec 

f^M5CRAD 

X5 

262.47    ft/sec 

Figure  12  - 


TABLE  4-VELOCITY  ERROR  OF  TYPE  OF  INSTALLATION 
AT  FINAL  CHECKPOINT 
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APPENDIX  A 

BESOLTS  OF  ATIGS  SIMULATION  WITHOUT  FILTERING  OR  POSITION 

UPDATE 
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Figure  13  -   SQRT  OF  DOWN  RANGE  VARIANCE  <ATIGS  ONLY> 
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Figure  14  -   SQRT  OF  CROSS  RANGE  VARIANCE  <ATIGS  ONLY> 
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Figure  15  -   SQRT*  OF  DOWN  RANGE  VELOCITY  VARIANCE  <ATIGS 

ONLY) 
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Figure    16   - 


SQHT    OF    CROSSRANGE    VELOCITY    VARIANCE    <ATIGS 
ONLY) 
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APPENDIX  B 


RESULT  OF  ATIGS  SIMULATION  WITH  POSITION  RESET  ONLY 
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Figure    17   - 


SQRT  OF  DOWN  RANGE  VARIANCE  <ATIGS  WITH  POSIT 
RESET) 
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Figure    18    - 


SQRT  OF  CROSS  RANGE  VARIANCE  <ATIGS  WITH  POSIT 
RESET* 
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Figure  19  - 


SQRT  OF  DOWNRANGE  VELOCITY  VARIANCE  <ATIGS  WITH 
POSIT  RESET) 
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Figure   20   - 


SQRT  OF  CROSS  RANGE  VELOCITY  VARIANCE  <ATIGS 
WITH  POSIT  RESET* 
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T  IME 


MEAN  PF  TRACK 


VAR  OF  TRACK 


MFAN  CF  ERROR 


VAR  OF  ERROR 


1          X(l> 
X<2» 

-0.638470 

C2 

0.405150 

06 

-0.638470 

02 

0.405150    06 

0. 70000C 

03 

0.102220 

00 

0.300000 

02 

0.  187750-03 

t                     X(3» 

-0.232040 

C3 

0.364500 

06 

-0.232040 

03 

0.364500    06 

X<4> 

0.0 

0.0 

-0.300000 

02 

0.107750-03 

X<5) 

0-350000 

C5 

0.255550 

03 

(VO 

0.0 

X(6I 

0.0 

0.0 

O.O 

0.0 

2          X(  1) 
X<2I 

0.63827C 

C3 

0.405380 

06 

-0.640290 

02 

0.406060    06 

0. 76440D 

C3 

0.121900 

00 

0.297980 

02 

O.47O01D    02 

X<3J 

-0.201S2D 

C3 

0. 364180 

06 

-0.231610 

03 

0.36<>26D    06 

XHI 

0.333900- 

C2 

0.151320- 

02 

-0.293720 

02 

0.501740    02 

X<51 

0.35O00D 

C5 

0.255550 

03 

0.72914D- 

02 

0.445240    00 

X(6) 

0.0 

0.0 

0.  145830- 

01 

0.178100    01 

3          X(l» 

0.  146930 

C4 

0.405800 

06 

-0.644710 

02 

0.40831D    06 

X<2> 

0. 9576CO 

03 

0.191300 

00 

0.293560 

02 

0.120970    03 

X<3I 

-0. 17224C 

03 

0.364080 

06 

-0.231490 

03 

0.364550    06 

X(4> 

0.133590- 

CI 

0.242110- 

01 

-0.296840 

02 

0.573500    02 

X(5I 

0.3500CD 

C5 

0.255550 

03 

-0.407340- 

■01 

0.486460    01 

X(6) 

0.0 

0.0 

-0. 110630 

00 

0.41122D    01 

4          X(l) 

0.255800 

C4 

0.405340 

06 

-0.652690 

02 

0.41053D    06 

X(2) 

0.  127940 

04 

0.341580 

CO 

0.287150 

02 

0.424010    03 

X(3) 

-0.  142140 

C3 

0.364100 

06 

-0.230790 

03 

0.365370    06 

X<4I 

0.30058D- 

CI 

0. 122570 

00 

-0.291330 

02 

0.67495D    02 

X(5) 

0.350000 

C5 

0.255550 

03 

-0.272120 

00 

0.10467D    02 

X»6I 

0.0 

0.0 

-0.352140 

00 

0.829830    01 

5          X(  1) 

0.403350 

C4 

0-404510 

06 

-0.664220 

02 

0.414370    06 

X12» 

0.  173040 

04 

0.624660 

00 

0.2/9190 

02 

0. 11 7C30    04 

X<  3  1 

-0.  1U6CD 

03 

0. 364660 

06 

-0.229170 

03 

0.367150    06 

X<4) 

0. 534360- 

CI 

0-337380 

00 

-0.286060 

02 

0.74 4 '.3D    0  2 

X15I 

0.35O00D 

05 

0.255550 

03 

-0. 589180 

00 

0. 502010    02 

X(6J 

1 

0.0 

0.0 

-0.281970 

00 

0.  145920    02 

6        ;iil 

0.596000 

04 

0.404770 

06 

-0. 684140 

02 

0.424770    06 

X(2) 

0.218120 

C4 

0.992520 

00 

0.2684  5  0 

02 

0.234090    04 

X(3) 

-0.821350 

C2 

0-365230 

06 

-0.220580 

03 

0.369800    06 

XCil 

-0.25677C- 

•01 

0.552200 

01 

-0.291160 

02 

0.  U39GD    03 

X(5J 

0.350000 

C5 

0.255550 

03 

-0-841830 

00 

0.  11  1090    03 

X(6) 

t 

0.0 

0.0 

-0.223340 

00 

0.229390    02 

7          X(l) 

0.827200 

C4 

0.404430 

06 

-0.725350 

02 

0.442920    06 

X(2I 

0.250320 

04 

0.  130720 

01 

0.252270 

02 

0-35182D    04 

X(3I 

-0.52602C 

02 

0.363530 

06 

-0.228000 

03 

0-37134D    06 

X(4) 

0.10535D 

CO 

0.445850 

02 

-0.287220 

02 

0.146570    03 

X(5) 

0.350000 

C5 

0.255550 

03 

-0. 1 1579D 

01 

0.219940    03 

X<6» 

0.0 

0.0 

-0.4088  70 

00 

0.393750    02 

8          X<  I) 

0. 108420 

05 

0.404020 

06 

-0.772950 

02 

0.470640    06 

X<2) 

0.269640 

C4 

0.151700 

01 

0.250050 

02 

0.42 74 5 D    04 

X(3) 

-0.22330C 

02 

0. 359780 

06 

-0.226620 

03 

0.373120    06 

X<4» 

0.  16312D 

00 

0.  107410 

03 

-0.287030 

02 

0.184000    03 

X(5) 

0.350000 

05 

0.255550 

03 

-0.164620 

01 

0.415290    03 

X(M 

0.0 

0.0 

-0.56/720 

00 

0.683270    02 

9           X(l» 

0.  135400 

C5 

0.403300 

06 

-0.82871D 

02 

0.507980    06 

X(2) 

0.276080 

04 

0.  159080 

01 

0.244140 

02 

0.451430    04 

X(3) 

0.  751  750 

01 

0. 354050 

06 

-0.225460 

03 

0.374460    06 

X<4) 

-0.386370 

OC 

0-151440 

03 

-0-288320 

02 

0.24259D    03 

X<5I 

C.3500CD 

05 

0.255550 

03 

-0.211050 

01 

0.750980    C3 

X(6I 

• 

0.0 

0.0 

-0.360820 

00 

0.  10054D    03 
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TIME  MEAN    CF     TRACK 

10  X(l)  0.162550  C5 
X(2)  0.272660  C4 
XI3I  0.373390  C2 
X<4)  -0.570360  CO 
X<5»  0.350CC0  C5 
X(6)  0.0 

11  X(l)  0.189540  C5 
X(2)  0.272860  C4 
X13)  0.662S90  C2 
XCil  -0. 599070  00 
X(5>  0.35O0CO  05 
X<6>  0.0 

X(l>  0.21652D  (5 

X12)  0.272860  C4 

X(3)  0.962310  02 

X<4|  -0.522420  CO 

X(5)  0.350000  C5 

X<6)  0.0 

X(ll  0.243510  C5 

X<2»  0.272360  C4 

X(3I  0.125560  C3 

X<41  -0.815340  CO 

X(5>  0.35OO0C  05 

X(6)  0.0 

X<1)  0.270500  C5 

X12)  0.272060  04 

X<3)  0. 153990  03 

X(4J  -0. 151100  01 

X<5I  C.3500CO  C5 

X(6)  0.0 

15 


VAR  OF  TRACK 


12 


13 


14 


16 


17 


18 


19 


0.402730  06 
0.15549D  01 
0.347690  06 
0.200250  03 
0.255550  Oi 
0.0 


0.402380  06 

0.155570  01 

0.341>«30  06 

0.220790  03 

0.255550  03 
0.0 

0.403330  06 

0.155640  01 

0.335270  06 

0-264780  03 

0.255550  03 
0.0 

0.402890  06 

0.155760  01 

0.329620  06 

0.288130  03 

0.255550  03 
0.0 

0.403460  06 

0.155840  01 

0.325390  06 

0.319170  03 

0.255550  03 
0.0 


MEAN    CF    ERROR 

-0.882870  02 

0.247610  02 

-0.223770  03 

-0.283810  02 

-0.2 '«1200  01 

-0.242200  00 

-0.933980  02 

0.248390  02 

-0.222600  03 

-0.2892^0  02 

-0.247700  01 

0.112150  00 

-0.987780  02 

0.246250  02 

-0.220830  03 

-0.279560  02 

-0.237090  01 

0.  100120  00 

-0.1034  70  03 

0.251480  02 

-0.219220  03 

-0.288120  02 

-0.218950  01 

0.262660  00 

-0.108  760  03 

0.245540  02 

-0.218880  03 

-0-296940  02 

-0.194500  01 

0.226290  00 


VAR  OF  ERROR 


XII) 

0.297480 

05 

0.403700 

06 

-0.  105840 

00 

X(2) 

0.272660 

C4 

0. 156200 

01 

0.243580 

02 

X(3) 

0. 181580 

C3 

0.321080 

06 

0.  104180 

01 

X(4) 

-0.24488D 

CI 

0.367920 

03 

-0.300890 

02 

X(5) 

0. 350000 

C5 

0.255550 

03 

-0.  168530 

01 

X(6) 

0.0 

0.0 

0.293150 

00 

XI  1) 

0. 324460 

C5 

0.40  3 7 5D 

06 

-0.5521 10 

01 

X(2) 

0.272860 

C4 

0.  156470 

01 

0.247L90 

02 

X<3) 

0.208820 

03   . 

0.317100 

06 

0.129350 

01 

X(4) 

-0.313670 

CI 

0.398200 

03 

-0.294870 

02 

X(5> 

O.35O00D 

C5 

0.255550 

03 

-0. 150300 

01 

X(6) 

0.0 

0.0 

0.715150- 

•01 

XC 11 

0.351460 

05 

0.403310 

06 

-0.997610 

01 

X(2) 

0.272860 

C4 

0.  156640 

01 

0.252320 

02 

X(3) 

0. 236250 

C3 

0. 313830 

■  06 

0.20564D 

01 

X(4» 

-0.230980 

CI 

0.481430 

03 

-0.292760 

02 

X(5J 

0.35000C 

05 

0.255550 

03 

-0. 101990 

01 

X(6) 

0.0 

0.0 

0.894640 

00 

XII) 

0.3  784  40 

C5 

0.403640 

06 

-0.  149840 

02 

X(2) 

0.272860 

C4 

0.  156660 

01 

0.246890 

02 

X(3) 

0.263C20 

C3 

0. 310540 

06 

0.  151890 

01 

X(4> 

-0.257280 

CI 

0.482640 

03 

-0.302300 

02 

X(5J 

0. 350000 

C5 

0.255550 

03 

-0.236950 

00 

X(b) 

0.0 

0.0 

0.671280 

00 

X(  1  ) 

0.405430 

C5 

0.404400 

06 

-0.200050 

02 

X<2) 

0.272860 

C4 

0.156730 

01 

0.248580 

02 

X(3) 

0.290390 

C3 

0. 308730 

06 

0. 195350 

01 

X(4) 

-0.302100 

01 

0.477730 

03 

-0.292370 

02 

X(5) 

0. 350000 

C5 

0.255550 

03 

0.329740 

00 

X(6) 

0.0 

0.0 

0.462100 

00 

0.554220  06 
0. 435590  04 
0.375950  06 
0.277950  03 
0.  128960  04 
0.130100  03 

0.609750  06 
0.44  2000  04 
0.37840D  06 
0.295690  03 
0.210860  04 
0.160780  03 

0.676970  06 
0.448710  04 
0.381300  06 
0.31910D  03 
0.326170  04 
0.  192600    03 

0.  75031D  06 
0. 434260  04 
0.384990  06 
0.370220  03 
0.481360  04 
0.227230    03 

0.832670  06 

0.435970  04 

0.390140  06 

0.437770  03 

0.679190  04 

0.23  8  46  0  0  3 

0.47197D  02 

0.440220  04 

0.510090  02 

0.488020  03 

0.928400  04 

0.29  3  09  0  0  3 

0.450450  04 

0.434630  04 

0.57639C  03 

0.50  4  130  0  3 

0.  123860  05 

0.314C50  03 

0.175180  05 

0.433940  04 

0.211690  04 

0.531830  03 

0.161130  05 

0.3".8450  03 

0.390460  05 

0.433990  04 

0.465990  04 

0.555830  03 

0.205310  05 

0.380510  03 

0.69720D  05 

0.444560  04 

0.83571D  04 

0.626260  03 

0.257160  05 

0.416370  03 
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TIME 


MEAN    OF     TRACK 


VAP.    OP     TRACK 


MEAN    CF    ERROR 


VAR    OF    ERROR 


20 


21 


Z2 


23 


24 


25 


26 


27 


28 


29 


X(  11 

0 

4324  10 

C5 

X(2) 

0. 

272060 

C4 

X(  3> 

0. 

31 7180 

C3 

X<47 

-0. 

339630 

01 

xm 

0. 

345260 

C5 

X(6J 

-0. 

947160 

C3 

X(l) 

0. 

459390 

05 

X<2> 

0. 

272860 

C4 

X(3) 

0 

343540 

C3 

X(4I 

-0. 

374820 

CI 

X(5) 

0. 

334340 

05 

X<6) 

-0 

12380C 

04 

X(  1  1 

0. 

486380 

05 

X(2J 

0. 

272860 

C4 

XI3I 

0. 

369650 

03 

X(4) 

-0. 

419010 

CI 

X(5) 

0. 

321960 

C5 

X(6) 

-0. 

1238CD 

C4 

X(l) 

0. 

513J70 

C5 

X<2J 

0. 

27236C 

04 

X(3) 

0. 

394  790 

C3 

XUI 

-0. 

477210 

01 

X<5> 

0. 

30958D 

C5 

X(6I 

-0. 

123800 

C4 

xm 

0. 

540360 

05 

xm 

0. 

27286C 

C4 

X(3J 

0. 

420L60 

C3 

X(4> 

-0. 

538180 

01 

X(5I 

0. 

297200 

C5 

X<6) 

-0. 

123800 

C4 

xm 

0. 

567340 

05 

X<2> 

0. 

2  72860 

C4 

X(3» 

0. 

444680 

C3 

X(4( 

-0. 

5885C0 

CI 

X<5) 

0. 

284820 

C5 

X(6) 

-0. 

123800 

04 

X(l) 

0. 

594330 

05 

X(2) 

0. 

272660 

C4 

X(3) 

0. 

468620 

03 

X(4) 

-0. 

652440 

CI 

X<5) 

0. 

2/2440 

C5 

X(6l 

-0. 

123800 

C4 

X(l) 

0. 

621310 

05 

X(2) 

0. 

272860 

04 

X(3) 

0. 

491530 

C3 

X<4I 

-0. 

714090 

01 

X(5) 

0. 

26006D 

C5 

X(6) 

-0. 

123800 

C4 

X(l) 

0 

648290 

05 

X<2J 

0. 

272860 

C4 

X<3) 

0. 

514670 

C3 

XIM 

-0. 

742300 

CI 

X<5) 

0. 

247670 

C5 

X(M 

-0. 

123800 

C4 

xm 

0. 

675280 

C5 

X(2) 

0. 

272860 

C4 

XI3» 

o. 

537210 

03 

X<4| 

-0. 

806C30 

CI 

X<5» 

0. 

235290 

C5 

X<6I 

-0. 

1238C0 

C4 

0.404990  06 

0.156940  01 

0.307490  06 

0.51 79*0  03 

0.691450  05 

0.275580  06 

0.404590  06 

0.157170  01 

0-307290  06 

0.5594/0  03 

0.275080  06 

0.253040  01 

0.404570  06 

0. 157620  01 

0.308020  06 

0.5  7.4  20  03 

0.2  76000  06 

0.253040  01 

0.404620  06 

0. 158020  01 

0.308700  06 

0.592420  03 

0.276130  06 

0.253040  01 

0.40495U  06 

0. 157850  01 

0.310300  06 

0.589500  03 

0.2/C.260  06 

0.253040  01 

0.40496D  06 

0. 159010  01 

0.313600  06 

0.616970  03 

0.2  76390  06 

0.253040  01 

0.405040  06 

0. 138060  01 

0.317340  06 

0.637760  03 

0.276530  06 

0.2  53040  01 

0.40  54  90  06 

0.158450  01 

0.32  2  2  60  06 

0.666380  03 

0.276670  06 

0.253040  01 

0.405530  06 

0.158120  01 

0.328120  06 

0. 4  66180  03 

0.276820  06 

0.253040  01 

0.405600  06 

0.158400  01 

0.33  4  500  06 

0.69771D  03 

0.27698D  06 

0.253040  01 


-0.266240  02 

0.237210  02 

0.2912/D  01 

-0.280450  02 

-0.199630  01 

-0.5U41D  01 

-0.336480  02 

0-238320  02 

0.387210  01 

-0.290930  02 

-0.999400  01 

-0.108810  02 

-0.383450  02 

0.25331U  02 

0.477450  01 

-0.292670  02 

-0.209020  02 

-0.  10934D  02 

-0.425980  02 

0.25102D  02 

0.486130  01 

-0.298080  02 

-0.318580  02 

-0.109780  02 

-0.475990  02 

0.246090  02 

0.575020  01 

-0.292960  02 

-0.429520  02 

-0.112090  02 

-0.530400  02 

0.244470  02 

0.617090  01 

-0.301540  02 

-0.  54.2  040  02 

-0.112960  02 

-0.589170  02 

0.2  4  1260  02 

0-5^1490  01 

-0.306630  02 

-0.O56400  02 

-0.115750  02 

-0.647900  02 

0.240990  02 

0.491400  01 

-0.309320  02 

-0.7/4290  02 

-0.120050  02 

-0.715500  02 

0.235430  02 

0.456600  01 

-0.3050/0  02 

-0.893940  02 

-0.119250  02 

-0.778970  02 

0.239490  02 

0.416020  01 

-0.308500  02 

-0.10130U  03 

-0.120500  C2 


0.  109490  06 

0.454210  04 

0.133830  05 

0.647930  03 

0.324430  05 

0.20  16  90  0  4 

0. 157620  06 
0.4401/0  04 
0.194300  05 
0.64361D  03 
0.429920  05 
0.23  7540    04 

0.214370  06 
0-452760  04 
0.267950  05 
0.690000  03 
0.579580  05 
0.237390  04 

0.280560  06 
0.454800  04 
0.351820  03 
0.696040  03 
0.775650  05 
0.244690  04 

0.35556D  06 

0.456300  04 

0.447240  05 

0.723700  03 

0.102160  06 

0.245770  04 

0.439830  06 

0.459270  04 

0.559280  05 

0.  752610  03 

0.  131  760  06 

0.24002D  04 

0.53406D  06 
0.466140  04 
0.68963D  05 
0.831560  03 
0.166250  06 
0.25  04  4O  0  4 

0.638300  06 
0.46  3  000  0  4 
0.837590  05 
0.85693U  03 
0-205970  06 
0.259420  04 

0.751410  06 

0.468380  04 

0.100520  06 

0.940830  03 

0.251090  06 

0.262050  04 

0.874750  06 

0.474870  04 

0.118200  06 

0.877460  03 

0.30157D  06 

0.265420  04 
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TIME 


MEAN  OF  TRACK 


VAR  OF  TRACK 


MFAN  OF  ERROR 


VAR  CF  EPROR 


30 


31 


32 


33 


34 


35 


36 


37 


38 


39 


Xl  I  I 
X<2) 

0. 702260 

05 

0.272860 

C4 

X(3) 

0.558520 

C3 

X(  .1 

-0.875940 

01 

X<5> 

0.222910 

C5 

X(6t 

-0.  123800 

04 

XII 

0.729240 

C5 

X<2> 

0.272860 

C4 

X(3I 

C.5794C0 

03 

X<4» 

-0. 904100 

CI 

X<5) 
X(6) 

0.210530 

C5 

-0. 123800 

C4 

X(l) 

0. 756220 

C5 

X<2> 

0.27286D 

C4 

X(3I 

C. 600280 

C3 

X<4) 

-0.992730 

01 

XC  5) 

0. 198  150 

05 

X(6) 

-0. 123800 

C4 

>  (  I  ) 

0.783210 

C5 

X(2) 

0.2/2860 

C4 

X(3) 

C620C70 

C3 

X<4) 

-0. 108740 

02 

X<5» 

0. 185770 

C5 

X<6) 

-0. 123800 

04 

xm 

0.810190 

C5 

X(2) 

0.272860 

C4 

X(3» 

0.638630 

03 

X(4) 

-0.  123100 

C2 

X(5) 

0.  173390 

05 

X(6) 

-0. 123800 

04 

X(l) 

0.8371UD 

C5 

X(2i 

0.2/2360 

C4 

X(3» 

0.656030 

03 

X<4> 

-0.  12  7540 

C2 

X(5) 

0.  161010 

C5 

X(6) 

-0. 123800 

C4 

Mil 

0.864  170 

05 

X(2) 

0.272860 

C4 

X(  3) 

C. 672700 

C3 

X<4> 

-0.  137130 

C2 

X(5> 

0.  148630 

05 

X<6) 

-0.  123800 

C4 

XI  11 

0.891  160 

C5 

X(2) 

0.272860 

C4 

X(3> 

0.689480 

03 

XC,  ) 

-0.  136  J60 

02 

X<5> 

0.  1362S0 

C5 

X(6» 

-0.  123800 

C4 

X(ll 

0.918140 

C5 

X(2) 

0.272860 

C4 

X(3» 

0. 705560 

C3 

X<4) 

-0.  144190 

C2 

X<5» 

0.  1238  ?0 

C5 

X<6) 

-0.  12380P 

04 

X(  U 

C. 945 130 

C5 

X(2) 

0.27286D 

04 

X(3> 

0. 720410 

03 

XIII 

-0. 154220 

C2 

X<5» 

0.1  11490 

05 

X(6> 

-0.  123000 

C4 

0.406460  06 

0. 158640  01 

0.343150  06 

0.69596D  03 

0.2  77140  06 

0.253040  01 

0.406990  06 

0.150660  01 

0.353510  06 

0. 713830  03 

0.277300  06 

0.253040  01 

0.4084  20  06 

0. 159240  01 

0.365260  06 

0- 746670  03 

0.27/470  06 

0.25304D  01 

0.4094  30  06 

0. 159850  01 

0.377420  06 

0. 754  580  03 

0.27/650  06 

O.2  5304D  01 

0.409820  06 

0.16  02  70  01 

0.391840  06 

U.76009D  03 

0.27/83D  06 

0.253040  01 

0.409  700  06 

0.160780  01 

0-407230  06 

0.7/7550  03 

0.278010  06 

0.253040  01 

0.410200  06 

0.160750  01 

0.42  44  90  06 

0.304840  03 

0. 270200  06 

0.253040  01 

0.410270  06 

0.160/00  01 

0.442990  06 

0.30144D  03 

0.2/84  00  06 

0.253040  01 

0.410240  06 

0.160900  01 

0.462440  06 

0.79043D  03 

0.2/8600  06 

0.253040  01 

0.410850  06 

0.161050  01 

0.483060  06 

0.809320  03 

0.278300  06 

0.253040  01 


-0.844740  02 

0.235340  02 

0.30/230  01 

-0.307990  02 

-0.U3620  03 

-0.1243  70  02 

-0.92006D  02 

0.228500  02 

0.  1/8020  01 

-0.313230  02 

-0.126370  03 

-0.130600  02 

-0.99297D  02 

0.232740  02 

0.110450  01 

-0.30/540  02 

-0.139350  03 

-O.12H80O  02 

-0.106070  03 

0.235430  02 
-0.240650-01 

-0.31892D  02 

-0.152100  03 

-0.126270  02 

-0.112550  03 

O.2  3o0  70  02 

-0.105430  01 

-0.320800  02 

-0.164780  03 

-0.127230  02 

-0.118800  03 

0.238260  02 

-0.420130  01 

-0.324/30  02 

-0.177350  03 

-0.124240  02 

-0.124400  03 

0.241/10  02 

-0.658760  01 

-0.321110  02 

-0.189760  03 

-0.1239/0  02 

-0.12951D  03 

0.243940  0£ 

-0.824710  01 

-0.  3211-50  02 

-0.202160  03 

-0.123940  02 

-0.136290  03 

0.231390  02 

-0.108090  02 

-0.332120  02 

-0.214660  03 

-0.X26030  02 

-0.143100  03 

0.233180  02 

-0.146690  02 

-0.340590  02 

-0.22/610  03 

-0.1330/0  02 


0.  100620  07 

0.4621  /O  04 

0.137540  06 

0.933590  03 

0.357610  06 

0.272820  0  4 

0.  114610  07 

0.462690  04 

0.  160010  Ot 

0.  104190  04 

0.419250  06 

0.278310  04 

0-  129530  07 

0.461250  04 

0.184250  06 

0.  103840  04 

0.486550  06 

0.283010  04 

0.145310  07 

0.458610  04 

0.209580  06 

0.  106440  04 

0.559690  06 

0.288180  04 

0.  161950  0/ 

0.4598/0  04 

0.237470  06 

0.  110050  04 

0.638340  06 

0.286910  04 

0. 179590  07 

0.463190  04 

0.26/420  06 

0.  113890  04 

0.  /22610  06 

0.293/40  04 

0.19840D  07 

0.471540  04 

0.299130  06 

0.  U436D  04 

0.812720  06 

0.295230  04 

0.217680  07 

0.452970  04 

0.334190  06 

0.  12  34  40  04 

0.908760  06 

0.301270  04 

0.237940  07 

0-460650  04 

0.371820  06 

0.  126050  04 

0.  101160  0/ 

0. 308460  04 

0.259330  07 

0.463400  04 

0.41^060  06 

0.  135  750  04 

0.112090  07 

0.308430  04 
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TIME 

MEAN  OF  TRACK 

40      m> 

0.9721X0 

05 

X(2) 

0.272060 

C4 

X(3I 

0.734950 

C3 

X<4) 

-0. 159560 

C2 

X(5) 

0.991090 

C4 

X«6) 

-0. 123800 

04 

41    X(l) 

0.999C9D 

C5 

X(2) 

0.272860 

04 

X(3) 

0. 749120 

C3 

X(4I 

-0. 16182D 

C2 

X<5) 

0.867280 

04 

X(6I 

-0. 123800 

C4 

42    X<1) 

0.  102610 

06 

X(2I 

0. 273140 

C4 

X<3» 

0. 7627CO 

C3 

X(4) 

-0.171170 

02 

X(5 

0.  743  790 

C4 

X<6) 

-0. 1231S0 

C4 

43    X(l) 

0.105320 

06 

X(2» 

0.274550 

C4 

X(3) 

0. 775400 

C3 

X(4) 

-0. 171670 

C2 

X<5) 

0.622150 

C4 

X<6» 

-0. 12009C 

04 

44     X(l» 

0.108C70 

C6 

X<2) 

0.2ei5  10 

C4 

X(3> 

0.787200 

03 

X(4) 

-0. 1 74350 

C2 

X(5I 

0.509800 

C4 

X(6) 

-0.  104610 

C4 

45    X< 1 1 

0. 110940 

C6 

X(2) 

0.297860 

0-. 

X(3) 

0. 7986CD 

03 

X(4I 

-0.  102240 

C2 

X(5» 

0.423140 

04 

X<6» 

-0.687030 

C3 

46    X(l> 

0.  113960 

C6 

X(2) 

0. 31303O 

C4 

X(3» 

0. 8C8990 

C3 

X<4| 

-0. 1989CD 

02 

X(?l 

0.  37U6D 

04 

X<6> 

-0. 352  71D 

C3 

47    XU) 

0.  117120 

06 

X<2) 

0. 324550 

C4 

X<3> 
X(4) 

0.819040 

03 

-0.204C5D 

02 

X(5) 

0. 3485e0 

C4 

X(6) 

-O.9S8610 

02 

48    XU) 

0. 120350 

C6 

X(2) 

0.328200 

C4 

X  (31 

0.827850 

03 

X(4| 

-0. 218470 

C2 

X(5) 

0. 342720 

C4 

X(6) 

-0.  183  76D 

C2 

49    X  «  L 1 

0.  123610 

06 

X(2) 

0.329050 

C4 

X(31 

0.835390 

C3 

X(4) 

-0.226L40 

C2 

X<5> 

0.34  1810 

04 

X(6) 

0. 1906C0 

CO 

VAR    OF     TRACK 


0.4U270  06 

0.161200  01 

0.505090  06 

0.32J130  03 

0.279010  06 

0.253040  01 

0.411310  06 

0.161030  01 

0.520130  06 

0.817560  03 

0.279230  06 

0.25  3040  01 

0.409400  06 

0.157390  04 

0.551 710  06 

0.813300  03 

0.2  79  390  06 

0. 7614  80  04 

0-411660  06 

0.9195  70  04 

0.578990  06 

0.823630  03 

0.290730  06 

0. '.45860  05 

0.44512D  06 

0.413480  05 

0.606490  06 

0.811330  03 

0.36006U  06 

0.200800  06 

0.55*899  06 

0. 77^560  05 

0.634030  06 

0. 783220  03 

0.672890  06 

0.3  78680  06 

0. 765420  06 

0.643200  05 

0.660090  06 

0.742290  03 

0.126350  0  7 

0.312440  06 

0.967280  06 

0.23238D  05 

0.686680  06 

0.695010  03 

0. 1 77  740  07 

0.112/50  06 

0.10572D  07 

0.466510  04 

0. 711650  06 

0.667740  03 

0.200320  07 

0.226320  05 

0.107420  07 

0.273110  01 

0.737510  06 

0.695550  03 

0.205450  07 

0.225630  01 


MEAN    OF    ERROR 

-0.150280  03 

0.228530  02 

-0.101160  02 

-O.33270O  02 

-0.241150  03 

-0.137600  02 

-0.157790  03 

0.227880  02 

-0.213440  02 

-0.336730  02 

-0.254900  03 

-0.137420  02 

-0.164810  03 

0.227310  02 

-0.247270  02 

-0.335450  02 

-0.26913D  03 

-0.147290  02 

-0-173440  03 

0.202900  02 

-0.283500  02 

-0.J33860  02 

-0.285220  03 

-0.174480  02 

-0.  184620  03 

0.169320  02 

-0.328790  02 

-0.338/50  02 

-0.304190  03 

-0.204870  02 

-0.199730  03 

0.130620  02 

-0.377690  02 

-0.343590  02 

-0.325440  03 

-0.2201 70  02 

-0.214360  03 

0.17<t4  40  02 

-0.425430  02 

-0.341050  02 

-0.344670  03 

-0.164480  02 

-0.222760  03 

0.24  7390  02 

-0.464020  02 

-0.339860  02 

-0.357350  03 

-0.8901 70  01 

-0.227460  03 

0.272280  02 

-0.505870  02 

-0.342660  02 

-0.364150  03 

-0.4  704  60  01 

-0.229350  03 

0.290070  02 

-0.54187D  02 

-0.334710  02 

-0.368080  03 

-0.315820  01 


VAR    OF    FRROR 

0.281430  07 

0.458  710  04 

0.456610  06 

0.136700  04 

0.123570  07 

0.30665D  04 

0.30444D  07 

0.460100  04 

0.502470  06 

0. 137630  04 

0.  135650  07 

0.310740  04 

0.32824D  07 

0.466010  04 

0.549860  06 

0.137260  04 

0.  148190  07 

0.306460  04 

0.354210  07 

0.539910  04 

0.602070  06 

0.  149C0D  04 

0.160450  07 

0.270940  04 

0.381830  07 

0.557840  04 

0.657450  06 

0.148790  04 

0.  172060  07 

0.245760  04 

0.H08  7D  0  7 

0.574030  04 

0.714  2  50  0  6 

0.  150120  04 

0.183320  07 

0.242490  04 

0.441880  07 

0.614780  04 

0.772320  06 

0.144360  04 

0.194340  0  7 

0.25U650  04 

0.474110  07 

0.658410  04 

0.83  244D  06 

0.  14  7270  04 

0.204400  07 

0.226910  04 

0.508620  07 

0.706850  0  4 

0.894460  06 

0.151910  04 

0.212920  07 

0.  181370  04 

0.545460  07 

0.734690  04 

0.961190  06 

0.  158390  04 

0. 220640  07 

0.1655  10  04 
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TIME 


MEAN    OF     TPACK 


50 


51 


52 


53 


54 


55 


56 


57 


58 


59 


X(1J 

0. 

126370 

C6 

X  ( 2  I 

o. 

329050 

C4 

X<3> 

0. 

842950 

C3 

XCI 

-0. 

2292't0 

C2 

X<5) 

0. 

3418  3C 

04 

X(6) 

0. 

1986C0 

00 

X(  1) 

0. 

130120 

Of 

XUI 

.0. 

329050 

C4 

X(3) 

0. 

849220 

C3 

X(4) 

-0. 

23765C 

02 

X<5I 

0. 

3418  5C 

C4 

X(6l 

0. 

198600 

00 

XII) 

0. 

133390 

06 

X(2I 

0. 

329050 

C4 

X«3) 

0. 

85457D 

C3 

X<4» 

-0. 

250270 

02 

X<5» 

0. 

3413  70 

C4 

X(6) 

0. 

1986CD 

CO 

X(  1) 

0. 

136650 

06 

X<2> 

0. 

329C50 

C4 

X(3I 

0. 

85951C 

C3 

X<4> 

-0. 

257660 

C2 

X(5) 

0. 

341890 

C4 

X(6» 

0. 

198600 

00 

X(  1) 
X<2) 

0. 

139910 

ct 

0. 

329050 

C4 

X(3) 

0. 

863750 

C3 

X(4J 

-0. 

261 750 

C2 

X(5) 

0. 

3'.  15  30 

C4 

X<6> 

-0. 

7266CD 

CI 

X(  11 

0. 

143170 

06 

X<21 

0. 

329390 

04 

X(3) 

0. 

867380 

03 

X<4) 

-0. 

266380 

02 

X(5) 

0. 

341  180 

C4 

XI6) 

0. 

200690 

CO 

X(l) 

0. 

146440 

C6 

X(2) 

0. 

329390 

C4 

X<3) 

0. 

370C1D 

C3 

X(4l 

-0. 

273800 

02 

X(5) 

0. 

340830 

C4 

X(6) 

-0. 

726510 

CI 

<(  1) 

0. 

1497C0 

C6 

X<2> 

0. 

32973D 

C4 

X(3) 

0. 

871880 

03 

X<4» 

-0. 

289840 

02 

X<5) 

0. 

339730 

C4 

X(6l 

-0. 

147350 

02 

X(  1) 
X<2) 

0. 

152970 

C6 

c. 

330410 

04 

X(3I 

0. 

872250 

C3 

X<4) 

-0. 

295030 

C2 

X<5) 

0. 

339000 

C4 

X(6) 

0. 

199C00 

00 

X(  1) 

0. 

15625D 

C6 

X(2) 

c. 

330410 

04 

X(3) 

0. 

871930 

C3 

X<4) 

-0. 

308010 

02 

X<5» 

0. 

33790D 

04 

X(6) 

-0. 

221970 

02 

VAR    OF     TRACK 

0.  1074  70  07 

0.274010  01 

0.762310  Ob 

0.698580  03 

0.205460  07 

0.225630  01 

0. 10752D  07 

0.2  74  160  01 

0.788650  06 

0.703480  03 

0.20546D  07 

0.225630  01 

0.107630  07 

0.28031D  01 

0.811390  06 

0.627810  03 

0.205470  07 

0.22563IJ  01 

0.107530  07 

0.280700  01 

0.831770  06 

0.618040  03 

0.205480  07 

0.225630  01 

0. 107600  07 

0.280220  01 

0.352040  06 

0.619390  03 

0.204320  07 

0. 1 10630  05 

0.10773D  07 

0.22H150  04 

9.869720  06 

0.583620  03 

0.203710  07 

0.226500  01 

0.108310  07 

0.228150  0'. 

0.8894  10  06 

0.586210  03 

0.204430  07 

0.110840  05 

0.108900  07 

0.45423D  04 

0.907950  06 

0.595720  03 

0.207220  07 

0.221330  05 

0.109890  07 

0.901150  04 

0.925890  06 

0.562  70D  03 

0.209860  07 

0.230830  01 

0-112550  07 

0.90U70  04 

0.9422  70  06 

0.5614  70  03 

0.211970  07 

0.329360  05 


MEAN    CF     ERROR 

-0.230730  03 

0.287410  02 

-0.580630  02 

-0.339440  02 

-0.3  71141?  03 

-0.295030  01 

-0.232430  03 

0.286270  02 

-0.626420  02 

-0.344370  02 

-0.374280  03 

-0.333410  01 

-0.233600  03 

0.290090  02 

-0.672270  02 

-0.342250  02 

-0.3/7260  03 

-0.261 760  01 

-0.234710  03 

0-289040  02 

-0.706090  02 

-0.332120  02 

-0.379550  C3 

-0.196220  01 

-0.234800  03 

0.294970  02 

-0.735310  02 

-0.330500  02 

-0.381580  C3 

-0.210510  01 

-0.235630  03 

0.207800  02 

-0.766100  02 

-0.331960  02 

-0.384130  03 

-0.299580  01 

-0.236730  03 

0.287100  02 

-0.306840  02 

-0.342250  02 

-0.386960  03 

-0.266450  01 

-0.237740  03 

0.285540  02 

-0.8  44150  02 

-0.333290  02 

-0.389850  03 

-0.311690  01 

-0.240040  03 

0.279020  02 

-0.884940  02 

-0.340610  02 

-0.393290  03 

-0.376340  01 

-0.241320  03 

0.28L34O  02 

-0.92»97D  02 

-0.336150  02 

-0.396610  03 

-0.286860  01 


VAR     OF     ERROR 


0.534260  07 

0. 736220  04 

0.103000  07 

0.160890  04 

0.228450  07 

0.  168540  04 

0.624340  07 

0.731840  04 

0.110170  07 

0.163060  04 

0.236  740  07 

0.  1823  70  04 

0.665430  07 

0.  720860  04 

0.  11 73  70  0  7 

0.  160600  04 

0.245370  07 

0.181390  04 

0. 708300  07 

0.73190D  04 

0-  124860  07 

0.  16369D  04 

0.254210  07 

0.  182C90  04 

0.752710  07 

0.737560  04 

0.  132850  07 

0.  169130  04 

0.263380  07 

0.  186200  04 

0.799040  07 

0.746420  04 

0.140820  07 

0.16468D  04 

0.27286D  07 

0.193350  04 

0.846330  07 

0.736820  04 

0.149350  07 

0.183120  04 

0.282450  07 

0.189660  04 

0.894760  07 

0.  733780  04 

0.  153360  07 

0.184660  04 

0.292350  07 

0.  193760  04 

0.945670  07 

0.754260  04 

0.167590  07 

0.188830  04 

0.302  770  01 

0.203500  04 

0.998160  07 

0.75575D  04 

0.  176990  07 

0.186190  04 

0.313570  07 

0.208890  04 


68 


TIME 


MEAN    OF     TRACK 


60 


61 


62 


63 


65 


66 


67 


68 


69 


X(  I) 

0. 

15953D 

C6 

xm 

0. 

331420 

04 

X(3) 

0. 

B ?0680 

C3 

xu> 

-0. 

322270 

C2 

xm 

0. 

336C50 

C4 

X(6) 

-0. 

147350 

C2 

xm 

0. 

162810 

06 

XI2I 

0. 

332100 

C4 

X(3) 

0. 

867570 

C3 

XIM 

-0. 

3309eD 

02 

X(5) 

0. 

335330 

C4 

X(6) 

0. 

197840 

CO 

X(  1) 

0. 

166110 

06 

X<2) 

0. 

332100 

C4 

X<3) 

0. 

86^030 

03 

X(4I 

-0. 

34  4920 

C2 

xm 

0. 

3346CD 

C4 

X(6) 

-0. 

147330 

02 

Ml) 

0. 

169400 

06 

X(2) 

0. 

332760 

C4 

X<3> 

0. 

859190 

C3 

X(41 

-0. 

356650 

02 

X(5) 

0. 

333130 

C4 

X(6) 

-0. 

147340 

02 

Ml) 

0. 

172700 

C6 

X(2I 

0. 

333450 

C4 

X<31 

0. 

8526C0 

03 

XCil 

-0. 

369  120 

02 

X(5» 

0. 

331650 

C4 

X(6) 

-0. 

1474C0 

C2 

X<1) 

0. 

176010 

06 

X<2) 

0. 

334120 

04 

X(3) 

0. 

845220 

C3 

X  (♦) 

-0. 

3841  10 

C2 

X(5) 

0. 

3298C0 

C4 

X(6> 

-0. 

222C2D 

02 

xm 

0. 

179320 

06 

X(2) 

0. 

3  35140 

C4 

X(3  J 

0. 

83616C 

03 

X(4I 

-0. 

405620 

02 

XJ5) 

0. 

327580 

C4 

X(6) 

-0. 

221980 

02 

X(  1) 

0. 

182650 

C6 

X<2) 

0. 

336160 

04 

X<3> 

0. 

824390 

C3 

X<4| 

-0. 

422050 

02 

X(5) 

0. 

325740 

04 

X(6) 

-0. 

147290 

C2 

X(U 

0. 

185990 

C6 

X(2) 

o. 

336840 

C4 

X(3) 

0. 

811290 

C3 

X(4) 

-0. 

4  3  3  I  I C 

02 

X(5» 

0. 

324640 

C4 

X(6) 

-0. 

7262>;0 

CI 

X(l) 

0. 

189330 

06 

X(2I 

0. 

337170 

C4 

X(3) 

0. 

797040 

03 

X<4) 

-0. 

45328D 

C2 

X<5) 

0. 

322720 

04 

X(6I 

-0. 

J1202C 

02 

VAR    OF     TRACK 

0.117010  07 

0. I 5511U  05 

0.V56800  06 

0.548930  0^ 

0.21903D  07 

0.221200  05 

0.124110  07 

0.197440  05 

0.96637C  06 

0.565300  03 

0.223450  07 

0.232  731!  01 

0.134750  07 

0.197440  05 

0.972280  06 

0.561260  03 

0.225710  07 

0.220520  05 

0.14812D  07 

0.238770  05 

0.976670  06 

0.565650  03 

0.231410  07 

0.221180  05 

0. 164080  07 

0.279230  05 

0.980070  06 

0.584900  03 

0.234490  07 

0.221610  05 

0.185110  07 

0.318890  05 

0.980480  06 

0.597490  03 

0.237970  07 

0.328840  05 

0.212680  07 

0.376260  05 

0.979550  06 

0.60075D  03 

0.245100  07 

0.329040  05 

0.245780  07 

0.431670  05 

0.974380  06 

0.65422D  03 

0.251600  07 

0.220550  05 

0.285080  07 

0.467430  05 

0.966630  06 

0. 682250  03 

0.255340  0  7 

0. 1 10430  05 

0.332580  07 

0.484  790  05 

0.955050  06 

0.714950  03 

0.262460  07 

0.43  7430  05 


MEAN  OF  ERROR 

-0.243970  03 

0.279760  02 

-0.955720  02 

-0.330610  02 

-0.399870  03 

-0.305110  01 

-0.24593D  03 

0.285620  02 

-0.996450  02 

-0.341800  02 

-0.403280  03 

-0.317130  01 

-0.246640  03 

0.289220  02 

-0.103110  03 

-0.332720  02 

-0.406780  03 

-0.382690  01 

-0.247660  03 

0.289090  02 

-0.  106240  03 

-0.334620  02 

-0.410550  03 

-0.372800  01 

-0.248370  03 

0.291930  02 

-0.110460  03 

-0.343750  02 

-0.414780  03 

-0.473170  01 

-0.250100  03 

0.282930  02 

-0.114510  03 

-0.342940  02 

-0.419820  03 

-0.533830  01 

-0.251430  03 

0.290220  02 

-0.11838D  03 

-0.343030  02 

-0.424350  03 

-0.372210  01 

-0.251720  03' 

0.2950PO  02 

-0.123410  03 

-0.349680  02 

-0.428860  0? 

-0.534660  01 

-0.251920  03 

0.298120  02 

-0.128810  03 

-0.351680  02 

-0.4  33  740  03 

-0.435750  01 

-0.252730  03 

0.288240  02 

-0.  133520  03 

-0.343810  02 

-0.433250  03 

-0.46  72  90  01 


VAR    OF     ERROR 


0.105210  08 
0.747950  04 
0.  187310  07 
0.204730  04 
0.324970  07 
0.225240    04 

0.110790  oe 
0.771340  04 
0.19808D  07 
0.207430  04 
0.336750  07 
0.214940    04 

0.116520  06 
0.769UD  04 
0.208710  07 
0.201610  04 
0.348900  07 
0.230750    04 

0.  122420  08 
0. 772650  04 
0.219910  07 
0.210360  04 
0. 36  1450  0  7 
0.227960    04 

0:  12841D  08 
0. 767570  04 
0.231950  07 
0.22  4  640  0  4 
0.374270  07 
0.235330    04 

0.  134590  08 
0. 773950  04 
0.24 44  ID  0  7 
0.222290  04 
0.387  790  07 
0.253180  04 

0.140790  08 

0.  762630  04 

0.257390  07 

0.23232D  04 

0.401820  07 

0.242530  04 

0.14722D  08 
0.77986D  04 
0.270700  07 
0.231350  04 
0-416570  07 
0.275660  04 

0.153860  08 

0. 79400D  04 

0.20448D  07 

0.232420  04 

0.432040  07 

0.264270  04 

0.  160610  08 

0.783880  04 

0.290720  07 

0.237230  04 

0.4480UD  07 

0.291130  04 


69 


TIME 

MEAN    OF     TRACK 

VAR     OF     TRACK 

7C 

xm 

0. 192690 

06 

0.3912  40 

07 

X(2I 

0. 338590 

C4 

0.61769D 

05 

xm 

0. 780340 

C3 

0.938310 

06 

X(4I 

-0. 469960 

02 

0.806200 

03 

X(5I 

0. 3199  70 

C4 

0.272  75D 

07 

X16) 

-0.237290 

C2 

0.  37862D 

05 

71 

X(l) 

0.  196C4D 

C6 

0.46816D 

07 

X(2I 

0. 339660 

04 

0. 730280 

05 

X<3) 

0.761520 

C3 

0.91 7180 

06 

X<4) 

-0.494  140 

C2 

0.919310 

03 

X(5) 

0.317220 

C4 

0.280090 

07 

X(6l 

-0. 31202D 

C2 

0.487290 

05 

72 

X<  I) 

0.  199410 

06 

0.566810 

07 

X(2) 

0.341  100 

C4 

0.855660 

05 

X(3» 

0.740920 

C3 

0.09129D 

06 

X(4) 

-0.512260 

C2 

0. 1071 70 

04 

X(5» 

0.313810 

04 

0.291650 

07 

X<61 

-0.3/1270 

02 

0.54  3  7  00 

05 

73 

xm 

0.202800 

C6 

0-683080 

07 

X(2) 

0.342  7^0 

04 

0.926710 

05 

X<3» 

0.  71  7770 

03 

0.857650 

06 

X<4) 

-0.549620 

02 

0.129420 

04 

X(5I 

0.3112  10 

C4 

0. 300790 

07 

XUI 

-0. 147270 

C2 

0. 220450 

05 

74 

xm 

0.2062CD 

06 

0.814350 

07 

xm 

0.34346D 

04 

0.9534  7D 

05 

xm 

0.671990 

03 

0.815620 

06 

X<4I 

-0.575990 

02 

0. 164960 

04 

xm 

0. 300470 

C4 

0.308490 

07 

X<6) 

-0.402080 

C2 

0.643210 

05 

75 

M  1) 

0.209530 

C6 

0.338960 

07 

X(2I 

0.344610 

04 

0. 105990 

06 

X<3) 

0.665690 

03 

0. 769870 

06 

X  t  <f ) 

-0.608410 

02 

0.213680 

04 

X<5) 

0.306490 

04 

0.32  1650 

07 

Xi6) 

-0.38*400 

01 

0. 162350 

05 

76 

X(  I) 

0.2129:0 

C6 

0.100320 

08 

xm 

0.345010 

C't 

0.113570 

06 

X(3) 

0.633290 

C3 

0.713380 

06 

X<4) 

-0.635260 

C2 

0.2e3170 

04 

X(5I 

0.305610 

04 

0.32  756U 

07 

X(6) 

-0.8H62CD 

01 

0. 16187n 

05 

77 

X<  I) 

0.216370 

C6 

0. 1 19700 

08 

X(2) 

0. 345400 

04 

0.121040 

06 

X(3) 

0. 597330 

C3 

0.6522  90 

06 

xm 

-0.679830 

02 

0.380710 

04 

xm 

0.304800 

C4 

0.330800 

07 

X(6) 

-0.731 760 

01 

0. 1 11580 

05 

78 

X(  l  J 

0.219590 

C6 

0.112870 

08 

xm 

0.343700 

C4 

0.967260 

05 

X(3) 

0. 565560 

C3 

0. 592550 

06 

X(4) 

-0. 718330 

02 

0-(»58840 

04 

X<5) 

0.306590 

C4 

0.331310 

07 

X(6I 

-0. 5024CD 

02 

0.81 1840 

05 

79 

X(  I) 

0.222820 

C6 

0.100850 

08 

X(2) 

0. 3445E0 

C4 

0. 106610 

06 

X<3) 

0.524120 

03 

0.529950 

06 

XUI 

-0. 783460 

C2 

0.649940 

04 

xm 

0.306320 

04 

0. 340640 

07 

X<6I 

-0.430450 

02 

0.712820 

05 

MEAN  CF  ERROR 

-0.253530  03 

0.2946  30  02 

-0.138760  03 

-0.350180  02 

-0.442950  03 

-0.471660  01 

-0.254140  03 

0.293440  02 

-0.14436U  Oi 

-0.349630  02 

-0.440420  03 

-0.623880  01 

-0.255270  03 

0.292590  C2 

-0.  149210  03 

-0.341810  02 

-0.455070  03 

-0.706070  01 

-0.255280  03 

0.308950  02 

-0.153020  03 

-0.333130  02 

-0.460950  03 

-0.469020  01 

-0.254970  03 

0.301490  02 

-0.155650  03 

-0.329340  02 

-0.464830  03 

-0.307800  01 

-0.185890  03 

0.319240  02 

-0.153350  03 

-0.321010  02 

-0.462040  03 

-0.325600  01 

-0.183760  03 

0.327070  02 

-0.156010  03 

-0.32  7940  02 

-0.464870  03 

-0.239660  01 

-0.180550  03 

0.332350  02 

-0.158500  03 

-0.317740  02 

-0.467260  03 

-0.239460  01 

-0.629790  02 

0.3442  ID  02 

-0.146470  03 

-0.314070  02 

-0.417750  03 

-0.127070  01 

-0.518280  02 

0.344550  02 

-0.143470  03 

-0.312220  02 

-0.369540  03 

-0.232210  01 


VAR     CF     FRROR 


0.167620  08 

0.921980  04 

0.313600  07 

0.245630  04 

0.464890  07 

0.283880  04 

0.  17485D  08 

0.826160  04 

0.329230  07 

0.255960  04 

0.482390  07 

0.3O807D  04 

0.182240  08 

0.841650  04 

0.345530  07 

0.268990  04 

0.501130  07 

0.330770  04 

0.189840  08 

0.868180  04 

0.362180  07 

0.269720  04 

0.520610  07 

0.31 1950  04 

0.  197680  08 

0.832550  04 

0.379220  07 

0.267590  04 

0.540370  07 

0.312550  04 

0.  19712D  08 

0.831290  04 

0.398390  07 

0.269800  04 

0.56289D  07 

0.319  320  04 

0.204910  08 

0.040540  04 

0.416450  07 

0.233580  04 

0.504070  07 

0.314C70  04 

0.212830  0e 

0.830970  04 

0.435230  07 

0.28990D  04 

0.605890  07 

0.320320  04 

0.214270  08 

0.812840  04 

0.44  91 70  0  7 

0.299460  04 

0.619810  07 

0.335520  04 

0.22348D  08 

0.850580  04 

0.468020  07 

0.290840  04 

0.62332D  07 

0. 390800  04 


70 


TIME 
80 


MEAN  OF  TPACK 


82 


83 


84 


85 


X(l) 

0. 

225910 

C6 

XU) 

0. 

344140 

C4 

X  1  31 

0. 

489960 

03 

X(4> 

-o. 

866640 

02 

X<5) 

0. 

30754D 

C4 

X(6) 

-0. 

775660 

01 

xm 

0. 

229210 

06 

X(2) 

0. 

342*969 

C4 

X(3» 

0. 

431010 

C3 

X(4» 

-0. 

988650 

02 

X(5I 

0. 

311  150 

04 

X(6) 

-c. 

951220 

CI 

X(  1  ) 

0. 

23204D 

C6 

X<2) 

0. 

338560 

C4 

X(3) 

0. 

3 74  I  CO 

03 

X(4) 

-0. 

113660 

03 

X<5) 

0. 

326820 

C4 

X(6) 

-0. 

166430 

C2 

X(  1  ) 

0. 

234810 

Ct 

X<2> 

0. 

334250 

C4 

X(3» 

0. 

302750 

C3 

X{4> 

-0, 

123  740 

C3 

X(5I 

0. 

346900 

C4 

X(6i 

-0. 

907  74D 

CI 

xm 

0. 

2378':C 

C6 

X<2> 

0. 

331240 

C4 

X(3I 

0. 

2092SG 

03 

X(4) 

-0, 

148C0D 

C3 

X(5I 

0. 

353120 

C4 

X<6) 

-0. 

198010 

02 

X<1» 

0. 

239610 

C6 

X(2) 

0. 

328050 

C4 

X(3I 

0. 

741750 

C2 

XHI 

-0. 

168270 

C3 

X<5) 

0. 

237820 

04 

X(6) 

0. 

479920 

CO 

VAR  OF  TRACK 

0.827150  07 
0.1 12710  06 
0.463200  06 
0.633430  04 
0.346540  07 
0.1 18330  05 

0.871880  07 
0.956460  05 
0.402370  06 
0.102  000  05 
0.337d5D  07 
0. I  742  70    05 

0.485970  07 
0.560730  05 
0. 322699  06 
0.135140  05 
0.287080  07 
0.251380  05 

0.176510  07 
0.340230  05 
0.216080  06 
0.201270  05 
0.253320  07 
0.137570    05 

0.944410  06 

0.176540  05 

0.105700  06 

0.331500  05 

0.210470  07 

0.29'.2  70  05 

0.166260  06 

0.9554  70  03 

0.518400  05 

0.6  73910  05 

0.112580  07 

0.240020  01 


MEAN    OF    ERROR 


VAR     CF    ERROR 


o. 

289120- 

•01 

0. 

406620 

02 

0. 

297560 

00 

-0. 

297380 

02 

-0. 

311370 

03 

0. 

111  180 

01 

0 

105570 

02 

0. 

410650 

02 

0. 

927540 

00 

-0. 

287770 

02 

-0 

26  3000 

03 

0. 

223690 

01 

0 

146710 

02 

0. 

376290 

02 

0. 

478950 

01 

-o. 

280520 

02 

-0 

401900 

02 

0 

772270 

01 

0 

124140 

02 

0 

352010 

02 

0. 

76325D 

01 

-0 

279570 

02 

0. 

279380 

03 

0. 

132440 

02 

0 

218920 

02 

0. 

3608  50 

02 

0. 

102  790 

02 

-0 

2(32  8  40 

02 

0. 

405330 

03 

0. 

163681) 

02 

0 

307370 

03 

0 

922180 

02 

-0 

975580 

02 

-0 

522890 

02 

-0 

116540 

04 

0 

113220 

02 

0- 

614670 

02 

0. 

826020 

04 

0. 

540870 

02 

0 

269230 

0  4 

0 

634900 

07 

II. 

339500 

04 

<) 

813860 

04 

0 

802960 

04 

o. 

29  1620 

04 

0 

291270 

04 

0- 

644240 

07 

0. 

352610 

04 

0 

300510 

05 

0 

759020 

04 

0 

109900 

05 

0 

269340 

0  4 

0. 

596670 

07 

0 

208680 

0  4 

0. 

630940 

05 

u. 

707930 

04 

0. 

251960 

05 

0. 

280620 

04 

') 

53713D 

0  7 

0. 

272000 

04 

o.  100310  at 

0.644570  04 

0.436540  05 

0.266710  04 

0.495660  07 

0.259420  04 


0.609020  05 
0.23982D  04 
0.494680  05 
0.  187150  04 
.282860    07 


0.139810    04 
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APPENDIX  C 

RESULTS  OF  ATIGS  SIMULATION  WITH  POSITION  RESET  AND  KALMAN 

FILTERING 


72 


FT. 


m 


USE  ISA 


Figure  21  -   SQRT  OF  DOWN  RANGE  VARIANCE  <ATIGS  WITH 
POSITION  RESET  AND  KALMAN  FILTERING) 


73 


FT. 


=1 


Tiff  ISO 


Figure  22  -   SQRT  OF  CROSS  RANGE  VARIANCE  <AIIGS  WITH 
POSITION  RESET  AND  KALMAN  FILTERING) 


74 


FT/5K 


7.1 


E.I 


U 


U 


II 


2.1 


.1 


III    THE  (5KJ 


Figure  23  -   SQRT*  OF  DOWN  RANGE  VELOCITY  VARIANCE  <ATIGS 
WITH  POSITION  RESET. AND  KALMAN  FILTERING) 
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Figure  24  -   SQRT»  OF  CROSS-RANGE  VELOCITY  VARIANCE  <ATIGS 
WITH  POSTION  RESET  AND  KALHAN  FILTERING 
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APPENDIX  D 

RESULTS  OF  ATIGS  SIMULATION  WITH  POSITION  RESET  AND  KALMAN 

FILTERING  AT  X5  NOISE  LEVEL 
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Figure  25  -   SQRT*  OF  DOWN-RANGE  VARIANCE  <ATIGS  WITH  POSIT 
RESET  AND  KALMAN  FILTERING  AT  X5  NOISE  LEVEL> 
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Figure  26  -   SQRT*  OF  CROSS-RANGE  VARIANCE  <ATIGS  WITH  POSIT 
RESET  AND  KALtfAN  FILTERING  AT  THE  X5  NOISE  LEVEL> 
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Figure    27    -       SQRT*    OF    DOWN-RANGE    VELOCITY    VARIANCE    <ATIGS 
WITH    POSIT    RESET    AND    KALIAN    FILTERING    AT    THE    X5    NOISE    LEVEL> 
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Figure  28  -   SQBT.  OF  CROSS-RANGE  VELOCITY  VARIANCE  <ATIGS 
WITH  POSIT  RESET  AND  KALMAN  FILTERING  AT  THE  X5  NOISE  LEVEL' 
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APPENDIX  E 

PARTIAL  LISTING  OF  SYMBOLS  AND  NOMENCLATURE  OF  SIMULATION 

PROGRAM 


X(i,j)  i-th  missile  state  at  time  j 

THETA(i,j)  i-th  angular  state  variable  at  time  j 

XI(i,j)  estimated  i-th  state  at  time  j 

THETA(i,j)  estimated  i-th  angular  state  at  time  j 

XBAR(i,j)  mean  of  i-th  state  at  time  j 

XBVAR(i,j)  variance  of  i-th  state  at  time  j 

XMEAN(i,j)  error  mean  of  i-th  estimated  state 

XVAR(i,j)  error  variance  of  i-th  estimated  state 

A(j)  thrust  acceleration  at  time  j 


AWXY 
AWYY 
AWYZ 
AWZZ 


AWXX  velocity  changes  due  to  angular  rotation 

DELVX         changes  in  wind  components 

DELVY 
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BETA1 
BETA2 
BET  A3 


body  referenced  accelerations 


YIX 
YIY 
YIZ 


inertial  referenced  accelerations 


XPOS 
YPOS 


micrad  sensed  positions 


G1 
G2 


Kalman  gains  for  filter 


OMEGAX 
OMEGAY 


extra  states  for  Kalman  filter 


XINT 


dummy  variable  for  output 


PSI 


change  in  drift  angle 


XFIN(i) 


final  value  of  i-th  state  per  track 


NTERM 


maximum  time  steps  allowed 


VXO 


velocity  of  wind  down-range 


VYO 


velocity  of  wind  cross-range 


IX 


seed  number  for  random  number  generators 


DTHTAX 


change  in  thetax 


dthtxm 


measured  change  in  thetax 


ZNI(j) 


total   tracks   through   time   j 
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XIFIN  (i)  final   value  of  estimated  i-th  state  per 
track 

XBFIN(i)  mean  of  XFIN(i) 

XIBFN(i)  mean  of  XIFIN  (i) 

XBFV(i)  variance  of  XFIN(i) 

N  number  of  gyros  simulated 

NNA  number  of  accelerometers  simulated 

IENSB  size  of  ensemble 

SIGEO  std. deviation  of  gyro  bias 

SIGW  std. deviation  of  gyro  random  walk 

SIGK  std. deviation  of  gyro  scale  factor 

SIGEG  std. deviation  of  accelerometer  bias 

SIGKG  std. deviation   of   accelerometer   scale 
factor 

SIGT  std. deviation   of   initial   condition  on 
theta 
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APPENDIX  F 


SIMULATION  PROGRAM 
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//    EXEC    FORTCLGP,RE3ION=180K 

//FORT.SYSIN    DD  * 

C 

C      X(1,J)  THE  ACTUAL  POSITION  ALONG  THE  DOWNRANGE 

C  AXIS 

C      X(2,J)  THE  AIRSPEED  IN  THE  DOWNRANGE  DIRECTION 

C  NOTE  IT  IS  NOT  THE  ACTUAL  VELOCITY 

C      X(3,J)  CROSSRANGE  POSITION 

C      XJ4.J)  CROSS  RANGE  AIRSPEED 

C      XI(K,J)  THE  INERTIALLY  COMPUTED  STATES  ALONG  THE 

C  DOtfN-RANGE/CROSS-RANGE  AXIS 

C      XBAR  THE  MATRIX  OF  MEAN  VALUES  OF  THE  MONTE- 

C  •  CARLO  GENERATED  TRACKS  OF  THE  X  MATRIX 

C      XMEAN  THE  MATRIX  OF  MONTECARLO  GENERATED 

C  MEANS  OF  THE  XI  MATRIX 

C 

DIMENSION  NA(3)  , SOG(3)  , WG  (3)  , PS  I  ( 150)  ,G AM  (3 ) , ZNI  ( 1 50)  , 

DIMENSION  THETA  (3,150)  ,THETAI  13  .  150),  G  J  3)  ,  EO(3)  ,ZK(3)  , 

DIMENSION  A  (150)  ,XFIN  (6) , XI FIN (6)  , YF  (150)  ,XINT  (150)  ,XP 


C 


REAL* 8  XBFIN  16)   , XIBFN  (6)  ,XBFV  (6)  , XIBFV(6)  ,XM1,XM3 

REAL*8  XBAR  (6,  155)  , X3VAR(6,  1 55)  ,  X  (6  ,  1  5d)  ,  XI  (6  , 1  55) 

REAL*8  XMEAN(6,  150)  ,XVAR(6, 150 

DIMENSION  ERR  (6) 
C 

C      THIS  SECTION  READS  IN  THE  VARIOUS  NECESSARY  SPECIFICAT 
C         "N  »   THE  NUM3ER  OF  GYROS  INVOLVED  PER  SIMULATION 
C         "NNA"  THE  NUMBER  OF  ACCELEROMETEES  PER  SIMULATION 
C        "IENSB"   THE  NUMBER  OF  THE  ENSEMBLE 
C 


READ  (5,  30  0)  N,  NNA,  IENSB 
"SlGSO"  IS  " 


OF 
OF 

THE 
THE 

GYRO  BIAS 

RANDOM  WALK  CONSTANT 

OF 

OF 
OF 
OF 

THE 
THE 
THE 
THE 

SCALE  FACTOR  (GYRO) 
ACCEL.  BIAS 
ACCEL  SCALE  FACTOR 
INITIAL  CONDITION 

C  "SIGEO"  IS  THE  DIVIATION 
C  "SIGW"  IS  THE  DEVIATION 
C  FOR  THE  GYROS 

C  "SIGK"  IS  THE  DEVIATION 
C  "SIGEG"  IS  THE  DEVIATION 
C  "SIGKG"  IS  THE  DEVIATION 
C  "SIGT"  IS  THE  DEVIATION 
C  ON  THETA 

C 

READ  (5, 310) SIG EO, S IGW, SIGK, SIGEG, SIGK G,SIGT 
C 

C        "SIGMIC"  IS  THE  DEVIATION  OF  THE  POSITION  MEASUREMEN 
C 

READ(5,31 0) SIGMIC 

WRITE (0,420) N, NNA, IENSB 

WRITE (6,4  4  0) SIGEO , SIG W, SIGK, SIGEG , SIG KG , SI GT 

WRITE (6,500) SIGMIC 

CALL  OVFLOW 

INDX1=1 

INDX2=1 

INDX3=1 

NEEBG=1 

Y?=0.0 

NTERM=100 

IA=1 

IB=3 

IX=1111  1 

VXO=30. 0 

VYO=30. 0 

DO  02  J=1,NTERM 

DO  01  K=1 ,6 

XMEAN  (K,J)  =0.0 

XVAR  (K,  J)  =0.0 

XEAR  (K,  J)=0.0 

XEVAR  (K,J)  =0.0 

01  CONTINUE 

02  CONTINUE 
C 

C      GENERATE  THE  THRUST  ACCELERATION  PROFILE 


A  (1)=2.0 
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c 
c 
c 


c 
c 
c 
c 


c 

c 


c 
c 
c 
c 
c 


c 
c 
c 
c 
c 
c 
c 

c 
c 
c 
c 


A 
A 
A 

A 
A 
A 
A 


5!  i  =14.0 


=  6.0 
=  10.0 
=14.0 


=  10.0 
=  6.0 
=  2.0 


A  («) =Z.  0 
A  (91=- 1  .0 
DO  03  1=10,1 


50 


03  A(I)=0.0 
DO  04  J  =  1  ,6 
XBFIN (J)=0.0 

XIBFN(J)=0.0  . 

XBFV(J)  =0.0  * 

04  XIBFV(J)=0.0 

DO  05  I=1,NTERM 
ZNI  (I)=0.0 

05  A  (I)=A(I)  *32.2 

START  THE  MONTECARLO  SIMULATION 

DO  200  NI=1,IENSB 
TIMEX=1  .0 
OMEGAY=0.0 
CMEGAX=0.0 

THE  PURPOSE  OF  THIS  SECTION  IS  TO  COMPUTE  THE  INITIAL 
CONDITION  FOR  THE  ACTUAL  TRACK  OF  THE  MISSILE. 

CALL  RANDU(IX,IYfXFL) 

IX=IY 

X (1,1)  =XFL*2 240. 0-1 120.0 

10  CALL  RANDU  (IX,IY,YFL) 
IX=IY 

IF(  (XFL**2  +  YFL**2)  .GT.1  .  0)  GO  TO  10 

X(2,1)=700.0 

X (3,1) =YFL*224  0. 0-1120.0 

X  4,1  =0.0 

X  (5,1)=35000. 
XJ6.1) =0.0 

GENERATE  THE  INITIAL  CONDITIONS  ON  THETA 

CALL  SNORM(IX,T,N) 
DO  11  J=1,N 
THETAI (J,  1) =0.0 

11  THETA  (J,1)  =T  (J)  *SIGT 

THE  INITIAL  SETTING  OF  THE  INERTIAL  NAVIGATOR  IS 
ZERO  POSITION  IN  DOWN-RANGE  AND  CROSS-RANGE  AND  THE 
ACTUAL  VELOCITY  AND  ALTITUDE 

XI(1,1)=0.0 

XI  (2,1)  =670.0 
XI(3,  1)  =0.0 
XI(4,1)=30.0 

XI  (5, 1    =35000.0 
XI  (6,1    =0.0 
DTHTAX=0.0 
DTHTAY=0.0 
DTHTAZ=0.0 

THE    PURPOSE    OF    THIS    SECTION    IS    TO    PRODUCE    THE    ACTUAL 
TRACK    OF    THE    SIMULATED    MISSILE    FOR    COMPARISON    WITH 
OTHER    ESTIMATES    OF    POSITION 
WIND    EFFECTS    ARE    COMPUTED    FIRST 

THE    INITIAL    VALUE    OF    C    IS    ALWAYS    ZERO 
C  =  0.0 

THE    VARIOUS    RANDOM    INPUTS    FOR    MEASUREMENT    DEVICES     AFE 
GENERATED 


c 
c 
c 


c 
c 
c 
c 


c 

c 


c 
c 
c 


c 
c 
c 


c 
c 
c 
c 


c 

c 
c 


GENERATE  GYRO  BIAS 
CALL  SNORM  (IX,EO,N) 
DO  18  KN=1,N 
18  EC  (KN)=SIGEO*EO  (KN) 


30 


50 


51 


"EO" 


SCALE  FACTOR  "ZK" 


GENERATE  THE  RANDOM 
CALL  SNORM  (IX,ZK,N) 
DO  19  KN=1,N 

19  ZK  (KN)  =SIGK*ZK(KN) 

GENERATE  RANDOM  INPUTS  TO  ACCELEROMETER  PACKAGE 

GENERATE  ACCELEROMETER  BIAS  "EOG" 
CALL  SNORM  (IX  ,EOG,NNA) 
DO  20  KN=1,NNA 

20  EOG  (KN)  =SIGEG*EOG  (KN) 


GENERAT 
CALL  SN 
DO  30  K 
WG(KN)  = 
DO  100 
ZNI  (J)  = 
JF1=J+1 
CALL  RA 
IX=IY 
CALL  RA 
VY=30+  ( 
VX=30+  ( 
IX=IY 
AWXX=X ( 
AWXY=-X 
AWYY=X  ( 
AWYZ=X ( 
AWZZ=-X 
AWZX=-X 
AY=A  (J) 
THETA  (1 
THETA (2 
THETA  (3 
X  (1, JP1 
2,JP1 
3,JP1 
4,  JP1 
5,JP1 
6,JP1 


E  ACCELEROMETER 
ORM  (IX,WG,NNA) 
N=1 ,NNA 
SIGKG*WG (KN) 
J=1  ,NTERM 
ZNI(J)  +1.0 

NDU(IX,IY,  VY) 

NDU  (IX.IY.VX) 

VY*T6.67-8.33) 

VX*16.67-3.33 


SCALE  FACTOR  "KG" 


6, 

'4 


i 


*T 
,3 

;3 


J)  *D 

,J)  * 

J)*D 

J)  *D 

J>  * 


THTA 
DTHT 
THTA 
THTA 
DTHT 
DTHT 


1,J) +DTHTAX 

2, J) +DTHTAY 

3, J) +DTHTAZ 

,  J)  -VX+.5*  (A  (J)  +  AWXX+AWXY) 
J)  +AWXX  +  AWXY 

4, J)  +.5*  (AY+AWYZ+AWYY)  +  VY 
+AWYZ+AWYY 
6,  J) +.5* (AWZX+AWZZ) 
ZX+AWZZ 


GAM  IS  THE  NOISE  INPUT  FOR  EACH  ACCELEROMETER 

GAM  (1)=EOG  (1)  +WG  (1) 
GAM  (2)  =EOG  (2)  +WG  (2)  *C 
GAM  (3  =EOC 


GENERATE  THE  BIAS  TERM  DUE  TO  RANDOM  WALK 

CALL  SNORM  (IX,G,N) 

DO  50  JI=1  ,N 

G  (JI)  =SIGW*G  (JI) 

ANGLE  BETWEEN  THE 
ACTUAL  COORDINATE 


PSI    IS    THE 
COORDINATE 

CHANGE    IN 
PLANE    AND 

THE 

THE 

DO    51    JI=1,N 

PSI  (JI)  =EO(JI)  +  G(JI) 

DELVX=VXO-VX 
DELVY=VYO-VY 

COMPUTED 
PLANE 


COMPUTE  INERTIAL  POSITION 

DTHTXM=DTHTAX+?SI  (1) +DTHTAX*ZK (1) 
DTHTYM=DTHTAY+PSI  (2) +DTHTAY*ZK (2) 
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DTHTZM=DTHTAZ+PSI  (3) +DTHTAZ*ZK (3) 
C 

C      THE  GAINS  G1  AND  G2  ARE  THE  KALMAN  GAINS  GENERATED  AS 
C      A  FUNCTION  OF  TIME 
C 

G  1=  1. 0-2.0/ (TIM  EX +1 .0) 

G2=1.0/  (TIMEX+1.0) 
C 

C  THE    COMMANDED    HEADING    CHANGE    IS    SUBTRACTED    FROM    THE 

C  OESERVED    HEADING    CHANGE 

C 

.     DLYJ=DTHTYM-DTHTAY 

DIXJ=DTHTXM-DTHTAX 
C 

C  THE    FILTER    UPDATE    EQUATIONS    FOLLOW 

C 

THETAI  (1,J)=THETAI  (1 , J) +G1* (DLX J-OMEGAX) 

CMEGAX=OMEGAX+G2*  (DLXJ-OMEGAX) 

THETAI (2, J)=THETAI (2,  J)  +G1* (DLYJ-OMEGAY) 

OtJEGAY=OMEGAY+G2*  (DLYJ-OMEGAY) 
C 

C      THE  FILTERED  UPDATES  ARE  USED  TO  PREDICT  THE  NEXT 
C      STATE  IN  THE  NAVIGATOR 
C 

THETAI (1,JP1)  =THETAI  ( 1 , J)  +DTHTA X  +  OMEGAX 

THETAI (2,JP1)  =THETAI  (2 , J)  +DTHT AY+OMEGAY 

THETAI  ( 3,  JP1)  =THETAI  (3,  J)  +DTHTZM 

TIMEX=TIMEX+1.0 
C 

C      SINSED  ACCSLEROMETER  INPUTS  IN  THE  BODY  AXIS  FRAME 
C 

C      IN  THE  X(BODY  FR AME) DIRECTION 
C 

EETA1  =  A  (J) -DELVX+DELVY*THETA  (2,J) +GAM (1) 
C 

C      IN  THE  Y(BODY  FRAME)  DIRECTION 
C 

BETA2=DELVX*THETA  (2,3) +DELVY+GAM (2) 
C 

C      IN  THE  VERTICAL(BODY  FRAME) DIRECTION 
C 

BETA3=0.0 
C 

c 

C  THE  PURPOSE  OF  THIS  SECTION  IS  TO  GENERATE  THE 

C  INERTIAL  ESTIMATES  OF  POSITION  BASED  ON  A  PURE 

C  INERTIAL  COMPUTATION 
C 

C  AWXXI  IS  THE  ACCELERATIONS  DUE  TO  HEADING  CHANGE 

C  AFFECTING  THE  X  DIRECTION  FROM  THE  ANGLE  CHANGE  THETA 

C  X.   SIMILARLY  AWXYI  IS  THE  ACCELERATIONS   AFFECTING 

C  THE  X  DIRECTION  DUE  TO  THETAY 
AWXXI=XI(6,J)  *DTHTAX 

•  AfcXYI=-XI  (k.J)  *DTHTAY 


C 


AWYYI=_XI  (2,  J)  *DTHTAY 


AWYZI=XI  (6.  J)  *DTHTZM 

AhZZI=-XI  [k,  J)  *DTHTZM 

AWZXI=-XI  (2r J)  *DTHTAX 

DTHTXM=0.0 

DTHTYM=0.0 

DTHTZM=0. 0 

DTHTAX=0.0 

DTHTAY=0.0 

DTHTAZ=0. 0 
C 

C      SENSED  ACCELERATIONS  IN  THE  BODY  FRAME  ARE  CONVERTED 
C      TO  THE  INERTIAL  FRAME. 


YIX=BETA1-BETA2*THETAI (2, J) 
YIY=BETA1*THETAI  (2, J)  +BETA2 
IP  (J.EQ.  15)  GO  TO  48 
IF  (J.NE.80)  GO  TO  49 
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c 

c 

c 


GENERATE  THE  RANDOM  ERROR  IN  THE  POSITION  MEASUREMENT 

48  CALL  SNORM  (IX,XPOS,  1) 
XPOS=XPOS*SIGMIC 
CALL  SNORM (IX,YPOS,1) 
YPOS=YPOS*SIGMIC 
XI  (1,J)  =XPOS  +  X (1, J) 
(3,  J  J 


C 

c 
c 
c 


XI  (3,J  =YPOS+X 
49  CONTINUE 

XI  (6,  J)  =X  (6,  J) 

COMPUTE    THE    INSRTIAL    ESTIMATES 
AND    VELOCITY 


C 
C 
C 


88 


39 


90 
91 


100 
101 


C 
C 
C 


1  10 

120 


121 

200 


OF    POSITION 


XI 
XI 
XI 
XI 
XI 
XI 


1,JP1 

'2f  jpv 

[3,JP1 

u,jpr 
;5,jpi 

6,JP1 


=  XI 
=  XI 
=  XI 
=  XI 
=  XI 
=  XI 


vxo=vx 

VSO=VY 
II  (XI 
IF     (XI 

II  (DAB 


2,  J 
3,J( 

►8'J! 

5, J 

!6,  J" 


♦  XI  (2,  J)  +.  5*  (YIX+AWXXI+  AWXYI) 

+YIX+AWXXI+AWXYI 

+XI    4, J) +.5* (YIY+AWYYI+AWYZI) 

+YIY+AWYYI+AWYZI 

+  XIJ6.J)  +.5*(AHZZI  +  AWZXI) 

+AWZZI+AWZXI 


1,JP1) . GE. 4  0000.) DTHT A X=. 45 38-TH ETA (1, 
5,JP1) . LE. 5000.) DTHTAX=-THETA (1, JP1) 
(XI  (3rJ?1) )  .LE  .150.) GO  TO  88 

REM=24000Q.-XI (1,  j[ 

IF  (REM. LE. .001) GO  TO  88 

CCNTRL=X  (3,J)/REM 

DTHTAY=-CONTRL-THETAI  (2, JP1) 

CONTINUE 

THIS  SECTION  GENERATES  THE  REQUIRED  STATISTICS 


J?1) 


DC 
EE 
XM 
XE 
XE 
IF 
XV 
CO 
IF 
GO 
DO 
XE 
XI 
XI 
XI 
GO 
CO 
DC 
XE 
XI 
XI 
XI 


89  K=1.6 
R  (K)  =X  (K,  J)  -XI  (K,J] 
EAN  (KfJ)  =XMEAN(K, 


+  ERR(K) 

(K.J) **2 
GO  TO  89 
(K)  **2 

"(XIp7j+1)  .GT. 240000.)  GO  TO  90 

TO  1  00 

91  1=1 ,6 
IN(I)=X(I,J) 
FIN(1)  =  XI  (1 
FIN  <3)=XI 
FIN  (5) =XI 

TO  110 
NTINUE 

101  1=1 f 6 
IN (I)  =X  (I, 150) 
FIN(1)=XI(1,150 
FIN  (3)=XI  3,150 
FIN(5)=XI(5,  150 


3, J 
5, J 


THIS    SECTION    COMPUTES    THE    FINAL    VALUE    STATISTICS 

DO     120 
XEFIN(J 
XI3FN  (1 
XIBFN  (3 
XIEFN  (5 
XERR1=X 
XERR3=XFIN 
IE (XERR  1.L 
XBFVM)  =XB 
IE fXERR3.L 
XBFV(3)  =XB 
CONTINUE 
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